Lab5015Utils/setBoxTemp_PID.py at main · Lab5015/Lab5015Utils · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
#! /usr/bin/python3

import sys
import time
from Lab5015_utils import SMChiller
from Lab5015_utils import read_box_temp
from optparse import OptionParser
from datetime import datetime
from simple_pid import PID

parser = OptionParser()

parser.add_option("--target", type=float, dest="target", default=22.0)
parser.add_option("--box",    type=str, dest="box", default='big')
parser.add_option("--initialDelay", type=float, dest="initialDelay", default=60)
parser.add_option("--initialTemp", type=float, dest="initialTemp", default=19.5)
(options, args) = parser.parse_args()

debug = True

min_temp = options.target - 6.
max_temp = options.target + 6. #interval needs to be symmetrical not to diverge when a temp spike occurs

min_temp_safe = 10.
max_temp_safe = 40.

if options.target < min_temp_safe or options.target > max_temp_safe:
    print("### ERROR: set temperature outside allowed range ["+str(min_temp_safe)+"-"+str(max_temp_safe)+"]. Exiting...")
    sys.exit(-1)


SMC = SMChiller()

state = SMC.check_state()
print(datetime.now())
print(">>> SMChiller::state: "+str(state))

if state is 0:
    print("--- powering on the chiller")
    SMC.set_state(1)
    time.sleep(5)
    state = SMC.check_state()
    print(">>> SMChiller::state: "+str(state))
    if state == 0:
        print("### ERROR: chiller did not power on. Exiting...")
        sys.exit(-2)


box_temp = 22.
while True:
    try:
        box_temp = float(read_box_temp(options.box))
        break
    except ValueError as e:
        print(e)
        time.sleep(5)
        continue


water_temp = SMC.read_meas_temp()
new_temp = options.initialTemp
print("--- setting chiller water temperature at "+str(new_temp)+" C   [box temperature: "+str(box_temp)+" C   water temperature: "+str(water_temp)+" C]")
SMC.write_set_temp(new_temp)
sleep_time = options.initialDelay
print("--- sleeping for "+str(sleep_time)+" s\n")
sys.stdout.flush()
time.sleep(sleep_time)

pid = PID(0.3, 0., 70., setpoint=options.target)
pid.output_limits = (min_temp-options.target, max_temp-options.target)


while True:
    try:
        print(datetime.now())

        try:
            box_temp = float(read_box_temp(options.box))
        except ValueError as e:
            print(e)
            time.sleep(5)
            continue

        output = pid(box_temp)
        new_temp += output

        #safety check
        new_temp = min([max([new_temp,min_temp]),max_temp])

        if debug:
            p, i, d = pid.components
            print("== DEBUG == P=", p, "I=", i, "D=", d)

        water_temp = SMC.read_meas_temp()
        print("--- setting chiller water temperature at "+str(round(new_temp, 1))+"° C   [box temperature: "+str(box_temp)+"° C   water temperature: "+str(water_temp)+"° C]")
        SMC.write_set_temp(round(new_temp, 1))
        sleep_time = 45
        print("--- sleeping for "+str(sleep_time)+" s   [kill at any time with ctrl-C]\n")
        sys.stdout.flush()
        time.sleep(sleep_time)

    except KeyboardInterrupt:
        break

print("--- powering off the chiller")
SMC.set_state(0)
time.sleep(5)
state = SMC.check_state()
print(">>> SMChiller::state: "+str(state))
if state == 1:
    print("### ERROR: chiller did not power off. Exiting...")
    sys.exit(-3)
print("bye")
sys.exit(0)