diff options
author | Thomas Gubler <thomasgubler@gmail.com> | 2015-03-01 12:32:46 +0100 |
---|---|---|
committer | Thomas Gubler <thomasgubler@gmail.com> | 2015-03-01 12:33:04 +0100 |
commit | f10bcb037778ec47e947e724cd354a7d3de55473 (patch) | |
tree | 9772a70422697ec97988be2bf1634b61b0187cd6 | |
parent | 2b71bff85879fa0264877e9391f579d53071ea13 (diff) | |
download | px4-firmware-f10bcb037778ec47e947e724cd354a7d3de55473.tar.gz px4-firmware-f10bcb037778ec47e947e724cd354a7d3de55473.tar.bz2 px4-firmware-f10bcb037778ec47e947e724cd354a7d3de55473.zip |
mc pos ctrl multiplatform: do not publish att sp in offboard && no position/velocity control
-rw-r--r-- | src/modules/mc_pos_control_multiplatform/mc_pos_control.cpp | 17 |
1 files changed, 12 insertions, 5 deletions
diff --git a/src/modules/mc_pos_control_multiplatform/mc_pos_control.cpp b/src/modules/mc_pos_control_multiplatform/mc_pos_control.cpp index 2e14b744f..40268358a 100644 --- a/src/modules/mc_pos_control_multiplatform/mc_pos_control.cpp +++ b/src/modules/mc_pos_control_multiplatform/mc_pos_control.cpp @@ -1015,12 +1015,19 @@ void MulticopterPositionControl::handle_vehicle_attitude(const px4_vehicle_atti reset_yaw_sp = true; } - /* publish attitude setpoint */ - if (_att_sp_pub != nullptr) { - _att_sp_pub->publish(_att_sp_msg); + /* publish attitude setpoint + * Do not publish if offboard is enabled but position/velocity control is disabled, in this case the attitude setpoint + * is published by the mavlink app + */ + if (!(_control_mode->data().flag_control_offboard_enabled && + !(_control_mode->data().flag_control_position_enabled || + _control_mode->data().flag_control_velocity_enabled))) { + if (_att_sp_pub != nullptr) { + _att_sp_pub->publish(_att_sp_msg); - } else { - _att_sp_pub = _n.advertise<px4_vehicle_attitude_setpoint>(); + } else { + _att_sp_pub = _n.advertise<px4_vehicle_attitude_setpoint>(); + } } /* reset altitude controller integral (hovering throttle) to manual throttle after manual throttle control */ |