Browse Source

MulticopterPositionControl: clarify previous position control naming

main
Matthias Grob 3 years ago
parent
commit
4ffe796b4d
  1. 6
      src/modules/mc_pos_control/MulticopterPositionControl.cpp

6
src/modules/mc_pos_control/MulticopterPositionControl.cpp

@ -321,13 +321,13 @@ void MulticopterPositionControl::Run() @@ -321,13 +321,13 @@ void MulticopterPositionControl::Run()
setDt(dt);
if (_vehicle_control_mode_sub.updated()) {
const bool position_control_enabled = _vehicle_control_mode.flag_multicopter_position_control_enabled;
const bool previous_position_control_enabled = _vehicle_control_mode.flag_multicopter_position_control_enabled;
if (_vehicle_control_mode_sub.update(&_vehicle_control_mode)) {
if (!position_control_enabled && _vehicle_control_mode.flag_multicopter_position_control_enabled) {
if (!previous_position_control_enabled && _vehicle_control_mode.flag_multicopter_position_control_enabled) {
_time_position_control_enabled = _vehicle_control_mode.timestamp;
} else if (position_control_enabled && !_vehicle_control_mode.flag_multicopter_position_control_enabled) {
} else if (previous_position_control_enabled && !_vehicle_control_mode.flag_multicopter_position_control_enabled) {
// clear existing setpoint when controller is no longer active
_setpoint = {};
}

Loading…
Cancel
Save