- new template, changed dt to 3 for rast and sensor
- added plant timer git-svn-id: http://moon:8086/svn/projects/HendiControl@267 fda53097-d464-4ada-af97-ba876c37ca34
This commit is contained in:
@@ -58,8 +58,10 @@ class Controller(TimerListener):
|
||||
|
||||
self.rastTimer = Timer("Rast", self)
|
||||
self.sensorTimer = Timer("Sensor", self)
|
||||
self.plantTimer = Timer("Plant", self)
|
||||
self.reportTimer = Timer("Report", self)
|
||||
self.timerMgr.registerTimer(self.sensorTimer)
|
||||
self.timerMgr.registerTimer(self.plantTimer)
|
||||
self.timerMgr.registerTimer(self.reportTimer)
|
||||
self.rast_running = False
|
||||
|
||||
@@ -67,9 +69,6 @@ class Controller(TimerListener):
|
||||
if timer == self.sensorTimer:
|
||||
self.sensorTime_v = np.append(self.sensorTime_v, timer.count*self.sensor_dt / 60)
|
||||
|
||||
# Process plant
|
||||
self.plant.process()
|
||||
|
||||
# Temperature
|
||||
self.theta_raw = self.plant.getTemperature()
|
||||
|
||||
@@ -84,10 +83,14 @@ class Controller(TimerListener):
|
||||
Z = self.kalman.process_measurement((self.theta_raw, 0))
|
||||
xp = self.kalman.process(Z)
|
||||
self.theta_ist_k = xp[0, 0]
|
||||
self.heatrate_ist_k = xp[1, 0] * 60 / self.sensor_dt
|
||||
self.heatrate_ist_k = xp[1, 0] * 60
|
||||
self.theta_k_v = np.append(self.theta_k_v, self.theta_ist_k)
|
||||
self.heatrate_k_v = np.append(self.heatrate_k_v, self.heatrate_ist_k)
|
||||
|
||||
if timer == self.plantTimer:
|
||||
# Process plant
|
||||
self.plant.process()
|
||||
|
||||
if timer == self.reportTimer:
|
||||
self.report()
|
||||
|
||||
@@ -112,6 +115,7 @@ class Controller(TimerListener):
|
||||
print(json.dumps({recipe['Name'] : recipe}, indent=4, sort_keys=True))
|
||||
|
||||
self.sensorTimer.start(self.sensor_dt/self.sim_warp_factor)
|
||||
self.plantTimer.start(1/self.sim_warp_factor)
|
||||
self.reportTimer.start(self.report_interval)
|
||||
self.rastTimer.start(self.dt/self.sim_warp_factor)
|
||||
|
||||
@@ -257,7 +261,7 @@ class Controller(TimerListener):
|
||||
self.stirrer.setDutyCycle(1.0)
|
||||
|
||||
if ovenStateNext == ovenStates.HOLD:
|
||||
self.pid_hold.reset()
|
||||
# self.pid_hold.reset()
|
||||
self.stirrer.setSpeed(self.stirrSpeedRast)
|
||||
self.stirrer.setDutyCycle(self.stirrDutyRast)
|
||||
|
||||
|
||||
Reference in New Issue
Block a user