FlightModeManager: fix integral reset on ground

This information could also be used for yaw and integral
resets of the lower level controllers.

src/modules/flight_mode_manager/FlightModeManager.cpp

@@ -454,7 +454,7 @@ void FlightModeManager::generateTrajectorySetpoint(const float dt,
 		// set yaw-sp to current yaw
 		setpoint.yawspeed = 0.f;
 		// prevent any integrator windup
-		// _control.resetIntegral(); TODO
+		constraints.reset_integral = true;
 	}
 
 	_trajectory_setpoint_pub.publish(setpoint);

src/modules/mc_pos_control/MulticopterPositionControl.cpp

@@ -254,6 +254,10 @@ void MulticopterPositionControl::Run()
 			_control.setConstraints(constraints);
 			_control.setThrustLimits(constraints.minimum_thrust, _param_mpc_thr_max.get());
 
+			if (constraints.reset_integral) {
+				_control.resetIntegral();
+			}
+
 			// Run position control
 			if (_control.update(dt)) {
 				_failsafe_land_hysteresis.set_state_and_update(false, time_stamp_now);