RateControl: allow setting individual saturation flags

This helps for more complicated cases where certain axes are controlled
through and get feedback from a different allocator.

src/lib/rate_control/rate_control.cpp

@@ -47,13 +47,27 @@ void RateControl::setPidGains(const Vector3f &P, const Vector3f &I, const Vector
 	_gain_d = D;
 }
 
-void RateControl::setSaturationStatus(const Vector<bool, 3> &saturation_positive,
-				      const Vector<bool, 3> &saturation_negative)
+void RateControl::setSaturationStatus(const Vector3<bool> &saturation_positive,
+				      const Vector3<bool> &saturation_negative)
 {
 	_control_allocator_saturation_positive = saturation_positive;
 	_control_allocator_saturation_negative = saturation_negative;
 }
 
+void RateControl::setPositiveSaturationFlag(size_t axis, bool is_saturated)
+{
+	if (axis < 3) {
+		_control_allocator_saturation_positive(axis) = is_saturated;
+	}
+}
+
+void RateControl::setNegativeSaturationFlag(size_t axis, bool is_saturated)
+{
+	if (axis < 3) {
+		_control_allocator_saturation_negative(axis) = is_saturated;
+	}
+}
+
 Vector3f RateControl::update(const Vector3f &rate, const Vector3f &rate_sp, const Vector3f &angular_accel,
 			     const float dt, const bool landed)
 {

src/lib/rate_control/rate_control.hpp

@@ -75,8 +75,16 @@ class RateControl
 	 * Set saturation status
 	 * @param control saturation vector from control allocator
 	 */
-	void setSaturationStatus(const matrix::Vector<bool, 3> &saturation_positive,
-				 const matrix::Vector<bool, 3> &saturation_negative);
+	void setSaturationStatus(const matrix::Vector3<bool> &saturation_positive,
+				 const matrix::Vector3<bool> &saturation_negative);
+
+	/**
+	 * Set individual saturation flags
+	 * @param axis 0 roll, 1 pitch, 2 yaw
+	 * @param is_saturated value to update the flag with
+	 */
+	void setPositiveSaturationFlag(size_t axis, bool is_saturated);
+	void setNegativeSaturationFlag(size_t axis, bool is_saturated);
 
 	/**
 	 * Run one control loop cycle calculation