From 6649a03d44a632d16644e960d8ecc30282335c56 Mon Sep 17 00:00:00 2001 From: jens Date: Mon, 21 Dec 2020 12:23:56 +0100 Subject: [PATCH] - PID: no params for constructor - adedd dt - fixed set_params --- components/pid/pid.py | 12 +++++++----- 1 file changed, 7 insertions(+), 5 deletions(-) diff --git a/components/pid/pid.py b/components/pid/pid.py index 48bcc69..8cd7b68 100644 --- a/components/pid/pid.py +++ b/components/pid/pid.py @@ -1,8 +1,10 @@ class Pid: - def __init__(self, params): - self.params = params + def __init__(self, dt): + self.dt = dt + self.params = None + self.k = 1.0 # Integrator @@ -22,8 +24,8 @@ class Pid: def scale(self, k): self.k = k - def set_params(self, kp, ki, kd, kt): - self.params = dict(kp=kp, ki=ki, kd=kd, kt=kt) + def set_params(self, params): + self.params = params def reset(self): self.yi = 0 @@ -31,7 +33,7 @@ class Pid: self.awu = 0 def process(self, err, d): - dt = self.params['dt'] + dt = self.dt kp = self.params['kp'] * self.k ki = self.params['ki'] * self.k kd = self.params['kd'] * self.k