mc: add SYS_VEHICLE_RESP param to configure vehicle responsiveness

src/lib/mathlib/math/Functions.hpp

@@ -198,4 +198,16 @@ const T sqrt_linear(const T &value)
 	}
 }
 
+/*
+ * Linear interpolation between 2 points a, and b.
+ * s=0 return a
+ * s=1 returns b
+ * Any value for s is valid.
+ */
+template<typename T>
+const T lerp(const T &a, const T &b, const T &s)
+{
+	return (static_cast<T>(1) - s) * a + s * b;
+}
+
 } /* namespace math */