Browse Source

mc_pos_control: fix acc Z sign

sbg
Nicolas Martin 4 years ago committed by Matthias Grob
parent
commit
da4d0e650a
  1. 2
      src/modules/mc_pos_control/mc_pos_control_main.cpp

2
src/modules/mc_pos_control/mc_pos_control_main.cpp

@ -481,7 +481,7 @@ MulticopterPositionControl::set_vehicle_states(const float &vel_sp_z) @@ -481,7 +481,7 @@ MulticopterPositionControl::set_vehicle_states(const float &vel_sp_z)
_states.velocity(2) = _local_pos.z_deriv * weighting + _local_pos.vz * (1.0f - weighting);
}
_states.acceleration(2) = _vel_z_deriv.update(-_states.velocity(2));
_states.acceleration(2) = _vel_z_deriv.update(_states.velocity(2));
} else {
_states.velocity(2) = _states.acceleration(2) = NAN;

Loading…
Cancel
Save