- Compensate for max heat rate to reduce overshoot
This commit is contained in:
@@ -3,6 +3,7 @@
|
|||||||
class Pid:
|
class Pid:
|
||||||
def __init__(self, params):
|
def __init__(self, params):
|
||||||
self.params = params
|
self.params = params
|
||||||
|
self.k = 1.0
|
||||||
|
|
||||||
# Integrator
|
# Integrator
|
||||||
self.yi = 0
|
self.yi = 0
|
||||||
@@ -18,6 +19,9 @@ class Pid:
|
|||||||
# Output
|
# Output
|
||||||
self.y = 0
|
self.y = 0
|
||||||
|
|
||||||
|
def scale(self, k):
|
||||||
|
self.k = k
|
||||||
|
|
||||||
@staticmethod
|
@staticmethod
|
||||||
def params(kp, ki, kd, kt):
|
def params(kp, ki, kd, kt):
|
||||||
p = dict(kp=kp, ki=ki, kd=kd, kt=kt)
|
p = dict(kp=kp, ki=ki, kd=kd, kt=kt)
|
||||||
@@ -30,10 +34,10 @@ class Pid:
|
|||||||
|
|
||||||
def process(self, err):
|
def process(self, err):
|
||||||
dt = self.params['dt']
|
dt = self.params['dt']
|
||||||
kp = self.params['kp']
|
kp = self.params['kp'] * self.k
|
||||||
ki = self.params['ki']
|
ki = self.params['ki'] * self.k
|
||||||
kd = self.params['kd']
|
kd = self.params['kd'] * self.k
|
||||||
kt = self.params['kt']
|
kt = self.params['kt'] * self.k
|
||||||
|
|
||||||
self.yi = self.yi + ki*dt * err + kt*dt * self.awu
|
self.yi = self.yi + ki*dt * err + kt*dt * self.awu
|
||||||
yd = kd/dt*(err - self.err)
|
yd = kd/dt*(err - self.err)
|
||||||
|
|||||||
@@ -55,6 +55,10 @@ class TempController(AttributeChange):
|
|||||||
self.theta_ist = self.theta_ist_set
|
self.theta_ist = self.theta_ist_set
|
||||||
self.heatrate_ist = self.heatrate_ist_set
|
self.heatrate_ist = self.heatrate_ist_set
|
||||||
|
|
||||||
|
# Compensate for max heat rate to reduce overshoot
|
||||||
|
if self.heatrate_soll_set > 0:
|
||||||
|
self.pid_hold.scale(1.0/self.heatrate_soll_set)
|
||||||
|
|
||||||
self.heatrate_soll = self.heatrate_soll_set * self.pid_hold.get_y()
|
self.heatrate_soll = self.heatrate_soll_set * self.pid_hold.get_y()
|
||||||
theta_err = self.theta_soll_set - self.theta_ist
|
theta_err = self.theta_soll_set - self.theta_ist
|
||||||
heatrate_err = self.heatrate_soll - self.heatrate_ist
|
heatrate_err = self.heatrate_soll - self.heatrate_ist
|
||||||
|
|||||||
Reference in New Issue
Block a user