mc_pos_control: replacement for multirotor_pos_control, rewritten to C++ and new mathlib

src/lib/mathlib/math/Vector.hpp

@@ -261,6 +261,30 @@ public:
 		return res;
 	}
 
+	/**
+	 * element by element multiplication
+	 */
+	const Vector<N> emult(const Vector<N> &v) const {
+		Vector<N> res;
+
+		for (unsigned int i = 0; i < N; i++)
+			res.data[i] = data[i] * v.data[i];
+
+		return res;
+	}
+
+	/**
+	 * element by element division
+	 */
+	const Vector<N> edivide(const Vector<N> &v) const {
+		Vector<N> res;
+
+		for (unsigned int i = 0; i < N; i++)
+			res.data[i] = data[i] / v.data[i];
+
+		return res;
+	}
+
 	/**
 	 * gets the length of this vector squared
 	 */