Math: Add PidController class

include/Nazara/Math/PidController.inl

@@ -0,0 +1,28 @@
+// Copyright (C) 2021 Jérôme Leclercq
+// This file is part of the "Nazara Engine - Mathematics module"
+// For conditions of distribution and use, see copyright notice in Config.hpp
+
+#include <Nazara/Math/PidController.hpp>
+
+namespace Nz
+{
+	template<typename T>
+	PidController<T>::PidController(float p, float i, float d) :
+	m_lastError(0),
+	m_integral(0),
+	m_dFactor(d),
+	m_iFactor(i),
+	m_pFactor(p)
+	{
+	}
+
+	template<typename T>
+	T PidController<T>::Update(const T& currentError, float elapsedTime)
+	{
+		m_integral += currentError * elapsedTime;
+		T deriv = (currentError - m_lastError) / elapsedTime;
+		m_lastError = currentError;
+
+		return currentError * m_pFactor + m_integral * m_iFactor + deriv * m_dFactor;
+	}
+}