diff --git a/src/modules/mc_pos_control/mc_pos_control_main.cpp b/src/modules/mc_pos_control/mc_pos_control_main.cpp index b7654bb569..507c18ffdf 100644 --- a/src/modules/mc_pos_control/mc_pos_control_main.cpp +++ b/src/modules/mc_pos_control/mc_pos_control_main.cpp @@ -2361,12 +2361,14 @@ MulticopterPositionControl::update_velocity_derivative() } - if(PX4_ISFINITE(_local_pos.z_deriv)){ + if (PX4_ISFINITE(_local_pos.z_deriv)) { _z_derivative = _local_pos.z_deriv; }; _vel_err_d(0) = _vel_x_deriv.update(-_vel(0)); + _vel_err_d(1) = _vel_y_deriv.update(-_vel(1)); + _vel_err_d(2) = _vel_z_deriv.update(-_vel(2)); }