- PID: no params for constructor

- adedd dt
- fixed set_params
This commit is contained in:
jens
2020-12-21 12:23:56 +01:00
parent b9b1a1c613
commit 6649a03d44
+7 -5
View File
@@ -1,8 +1,10 @@
class Pid: class Pid:
def __init__(self, params): def __init__(self, dt):
self.params = params self.dt = dt
self.params = None
self.k = 1.0 self.k = 1.0
# Integrator # Integrator
@@ -22,8 +24,8 @@ class Pid:
def scale(self, k): def scale(self, k):
self.k = k self.k = k
def set_params(self, kp, ki, kd, kt): def set_params(self, params):
self.params = dict(kp=kp, ki=ki, kd=kd, kt=kt) self.params = params
def reset(self): def reset(self):
self.yi = 0 self.yi = 0
@@ -31,7 +33,7 @@ class Pid:
self.awu = 0 self.awu = 0
def process(self, err, d): def process(self, err, d):
dt = self.params['dt'] dt = self.dt
kp = self.params['kp'] * self.k kp = self.params['kp'] * self.k
ki = self.params['ki'] * self.k ki = self.params['ki'] * self.k
kd = self.params['kd'] * self.k kd = self.params['kd'] * self.k