- refactored PID params

This commit is contained in:
jens
2020-12-05 18:40:23 +01:00
parent 55aa043efb
commit 448afb3e9a
3 changed files with 37 additions and 41 deletions
+9 -6
View File
@@ -2,7 +2,9 @@ import numpy as np
class Pid:
def __init__(self):
def __init__(self, params):
self.params = params
# Integrator
self.yi = 0
@@ -25,11 +27,12 @@ class Pid:
self.yi = 0
self.err = 0
def process(self, dt, params, err):
kp = params['kp']
ki = params['ki']
kd = params['kd']
rho = params['rho']
def process(self, err):
dt = self.params['dt']
kp = self.params['kp']
ki = self.params['ki']
kd = self.params['kd']
rho = self.params['rho']
self.yi = rho*self.yi + ki*dt * err
yd = kd/dt*(err - self.err)