- removed dbug prints
- PID: added Anti Windup code
This commit is contained in:
@@ -31,11 +31,10 @@ class TempSensorTask(ATask):
|
|||||||
self.kalman = kalman
|
self.kalman = kalman
|
||||||
|
|
||||||
def on_temp_changed(self, value):
|
def on_temp_changed(self, value):
|
||||||
print("Sensor temp {}".format(value))
|
|
||||||
asyncio.create_task(self.send({'Temp': value}))
|
asyncio.create_task(self.send({'Temp': value}))
|
||||||
|
|
||||||
def on_temp_changed_kalman(self, value):
|
def on_temp_changed_kalman(self, value):
|
||||||
print("Kalman temp {}".format(value))
|
pass
|
||||||
|
|
||||||
async def recv(self, data):
|
async def recv(self, data):
|
||||||
print(data)
|
print(data)
|
||||||
@@ -120,11 +119,9 @@ class PotTask(ATask):
|
|||||||
plant_temp.set(round(self.plant.getTemperature(), 1))
|
plant_temp.set(round(self.plant.getTemperature(), 1))
|
||||||
|
|
||||||
if plant_power.is_changed():
|
if plant_power.is_changed():
|
||||||
print("Plant Power {}".format(plant_power.get()))
|
|
||||||
await self.send({'Power': plant_power.get()})
|
await self.send({'Power': plant_power.get()})
|
||||||
|
|
||||||
if plant_temp.is_changed():
|
if plant_temp.is_changed():
|
||||||
print("Plant Temp {}".format(plant_temp.get()))
|
|
||||||
await self.send({'Temp': plant_temp.get()})
|
await self.send({'Temp': plant_temp.get()})
|
||||||
|
|
||||||
await asyncio.sleep(self.interval)
|
await asyncio.sleep(self.interval)
|
||||||
@@ -230,9 +227,9 @@ if __name__ == '__main__':
|
|||||||
"Hold": {
|
"Hold": {
|
||||||
"Pid": {
|
"Pid": {
|
||||||
"kp": 0.8,
|
"kp": 0.8,
|
||||||
"ki": 0.000004,
|
"ki": 0.00001,
|
||||||
"kd": 0.0,
|
"kd": 0.0,
|
||||||
"rho": 1.0
|
"rho": 0.0
|
||||||
}
|
}
|
||||||
},
|
},
|
||||||
"Heat": {
|
"Heat": {
|
||||||
|
|||||||
@@ -11,6 +11,7 @@ class Pid:
|
|||||||
# Auto windup
|
# Auto windup
|
||||||
self.y_min = -1.0
|
self.y_min = -1.0
|
||||||
self.y_max = 1.0
|
self.y_max = 1.0
|
||||||
|
self.d = 0
|
||||||
|
|
||||||
# Output
|
# Output
|
||||||
self.y = 0
|
self.y = 0
|
||||||
@@ -30,7 +31,7 @@ class Pid:
|
|||||||
kd = params['kd']
|
kd = params['kd']
|
||||||
rho = params['rho']
|
rho = params['rho']
|
||||||
|
|
||||||
yi = rho*self.yi + ki*dt * err
|
yi = self.yi + ki*dt * err - ki*dt - self.d * rho
|
||||||
yd = err - self.xd
|
yd = err - self.xd
|
||||||
|
|
||||||
_yp = kp * err
|
_yp = kp * err
|
||||||
@@ -40,7 +41,9 @@ class Pid:
|
|||||||
y = _yp + _yi + _yd
|
y = _yp + _yi + _yd
|
||||||
|
|
||||||
self.y = max(self.y_min, min(self.y_max, y))
|
self.y = max(self.y_min, min(self.y_max, y))
|
||||||
|
self.d = max(0, self.y - y)
|
||||||
|
if self.d < 0:
|
||||||
|
print("d = {}".format(self.d))
|
||||||
self.yi = yi
|
self.yi = yi
|
||||||
self.xd = err
|
self.xd = err
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user