Merge pull request #417 from GaneshPatil7517/fix/pid2-use-computed-frequency

fix: use computed PID frequency in pid2.py instead of hardcoded value (fixes #366)

Author: pradeeban

tools/pid2.py

@@ -44,7 +44,7 @@ def  pid_controller(ym):
     if freq<10:
        freq = 10
     Prev_ErrorF = ErrorF      
-    ustar = np.array([amp,30])    
+    ustar = np.array([amp,freq])    
     return ustar