-
Notifications
You must be signed in to change notification settings - Fork 0
/
plutoGateway.py
155 lines (120 loc) · 4.7 KB
/
plutoGateway.py
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
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
import socket
from umodbus.client import tcp
from utils import set_bit,get_bit
import time
import json
from os import path
class PlutoGateway:
def __init__(self,channels_dict,plutoGateway_ip,plutoGateway_port):
print("plutoGateway:",plutoGateway_ip,plutoGateway_port)
self.sock = socket.socket(socket.AF_INET, socket.SOCK_STREAM)
self.sock.connect((plutoGateway_ip, plutoGateway_port))
self.dict = None
self.dict = channels_dict
self.channels=[]
for ch in self.dict.keys():
try:
exec("self." + ch + " = PlutoGatewayChannel(self,'" + ch + "')")
exec("self.channels.append(self." + ch + ")")
except Exception as e:
pass
raise e
def read_holding_registers(self, slave_id, starting_address, quantity):
message = tcp.read_holding_registers(slave_id, starting_address, quantity)
response = tcp.send_message(message, self.sock)
return response
def write_single_registers(self, slave_id, starting_address, val):
message = tcp.write_single_register(slave_id, starting_address, val)
response = tcp.send_message(message, self.sock)
return response
def read_bit(self, slave_id, address, bit):
message = tcp.read_holding_registers(slave_id, address, 1)
return get_bit(tcp.send_message(message, self.sock)[0],bit)
def write_bit(self, slave_id, address, bit,value):
message = tcp.read_holding_registers(slave_id, address, 1)
current_value = tcp.send_message(message, self.sock)[0]
new_value = set_bit(current_value,bit,value)
message = tcp.write_single_register(slave_id, address,new_value)
response = tcp.send_message(message, self.sock)
return response
def read_ch(self,ch):
dict = self.dict
if dict[ch]["bit"] != None:
return self.read_bit(dict[ch]["unit_id"],dict[ch]["addr"],dict[ch]["bit"])
else:
return self.read_holding_registers(dict[ch]["unit_id"],dict[ch]["addr"],1)[0]
def write_ch(self,ch,val):
dict = self.dict
if dict[ch]["bit"] != None:
while (self.read_bit(dict[ch]["unit_id"],dict[ch]["addr"],dict[ch]["bit"])!=val):
self.write_bit(dict[ch]["unit_id"], dict[ch]["addr"], dict[ch]["bit"], val)
time.sleep(0.001)
else:
while self.read_holding_registers(dict[ch]["unit_id"],dict[ch]["addr"])!=val:
self.write_single_register(dict[ch]["unit_id"],dict[ch]["addr"],val)[0]
time.sleep(0.001)
def press_ch(self,ch):
self.write_ch(ch, 0)
time.sleep(0.1)
self.write_ch(ch, 1)
time.sleep(0.5)
self.write_ch(ch, 0)
time.sleep(0.1)
def close(self):
self.sock.close()
self.sock = None
class PlutoGatewayChannel():
def __init__(self, server, ch):
self.ch = ch
self.type = type
self.server = server
self.default_value = self.server.dict[ch]["default_value"]
self.boot_value = self.server.dict[ch]["boot_value"]
self.type = self.server.dict[ch]["type"]
def read(self):
return self.server.read_ch(self.ch)
def write(self,val,note=""):
self.server.tester.log("Write %s to %s. %s"%(str(val),self.ch,str(note)))
return self.server.write_ch(self.ch,(val))
def press(self,note=""):
self.server.tester.log("Pressing %s. %s"%(self.ch,str(note)))
return self.server.press_ch(self.ch)
def checkValue(self,val,checkBlink=False):
if (val) is -1:
return True
if self.type == "Analog":
return abs(self.read()-int(val))<40
elif self.type == "DigitalBlink":
if checkBlink:
if val == 0:
return self.checkNoBlink()
elif val == 2:
return self.checkBlink()
else:
return True
else:
if val == "P":
return int(self.read())==int(0)
else:
return int(self.read()) is int(val)
def checkBlink(self,timeout=3):
zero = 0
one = 0
start = time.time()
while time.time() - start < timeout:
time.sleep(0.03)
reg = self.read()
if reg:
one += 1
else:
zero += 1
if zero > 2 and one > 2:
return True
return False
def checkNoBlink(self,timeout=1):
start = time.time()
while time.time() - start < timeout:
reg = self.read()
if reg != 0:
return False
return True