Maneuver/VehicleFormation/FormCollAvoid: Introduction of a verification to the formation controller output, to avoid sending commands with values not-a-number. Addition of parameter to regulate the wind averaging.