pid reset feature, if needed it can be reinitialised to 0

Author: askuric

src/common/pid.cpp

@@ -56,3 +56,9 @@ float PIDController::operator() (float error){
     timestamp_prev = timestamp_now;
     return output;
 }
+
+void PIDController::reset(){
+    integral_prev = 0.0f;
+    output_prev = 0.0f;
+    error_prev = 0.0f;
+}

src/common/pid.h

@@ -23,6 +23,7 @@ class PIDController
     ~PIDController() = default;
 
     float operator() (float error);
+    void reset();
 
     float P; //!< Proportional gain 
     float I; //!< Integral gain