Expanded Vehicleconstraints to xy for emergency braking

src/modules/flight_mode_manager/tasks/Auto/FlightTaskAuto.cpp

@@ -816,7 +816,7 @@ void FlightTaskAuto::_updateTrajConstraints()
 	// correction required by the altitude/vertical position controller
 	_constraints.speed_down = 1.2f * _param_mpc_z_v_auto_dn.get();
 	_constraints.speed_up = 1.2f * _param_mpc_xy_vel_max.get();
-	_constraints.speed_xy = 1.2f * _param_mpc_xy_vel_max.get();
+	_constraints.speed_xy = 1.2f * _param_mpc_xy_vel_max.get();;
 
 	if (_is_emergency_braking_active) {
 		// When initializing with large velocity, allow 1g of

src/modules/mc_pos_control/GotoControl/GotoControl.cpp

@@ -128,6 +128,7 @@ void GotoControl::update(const float dt, const matrix::Vector3f &position, const
 		.timestamp = goto_setpoint.timestamp,
 		.speed_up = NAN,
 		.speed_down = NAN,
+		.speed_xy = NAN,
 		.want_takeoff = false
 	};
 	_vehicle_constraints_pub.publish(vehicle_constraints);

src/modules/mc_pos_control/MulticopterPositionControl.hpp

@@ -119,6 +119,7 @@ class MulticopterPositionControl : public ModuleBase<MulticopterPositionControl>
 		.timestamp = 0,
 		.speed_up = NAN,
 		.speed_down = NAN,
+		.speed_xy = NAN,
 		.want_takeoff = false,
 	};