forked from fablabnbg/airco2ntrold
-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathairco2ntrol.py
84 lines (62 loc) · 1.92 KB
/
airco2ntrol.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
#!/usr/bin/env python3
# based on code by henryk ploetz
# https://hackaday.io/project/5301-reverse-engineering-a-low-cost-usb-co-monitor/log/17909-all-your-base-are-belong-to-us
import os, sys, fcntl, time, struct
def callback_function(error, result):
if error:
print(error)
return
print(result)
def decrypt(key, data):
cstate = [0x48, 0x74, 0x65, 0x6D, 0x70, 0x39, 0x39, 0x65]
shuffle = [2, 4, 0, 7, 1, 6, 5, 3]
phase1 = [0] * 8
for i, o in enumerate(shuffle):
phase1[o] = data[i]
phase2 = [0] * 8
for i in range(8):
phase2[i] = phase1[i] ^ key[i]
phase3 = [0] * 8
for i in range(8):
phase3[i] = ( (phase2[i] >> 3) | (phase2[ (i - 1 + 8) % 8 ] << 5) ) & 0xFF
ctmp = [0] * 8
for i in range(8):
ctmp[i] = ( (cstate[i] >> 4) | (cstate[i] << 4) ) & 0xFF
out = [0] * 8
for i in range(8):
out[i] = (0x100 + phase3[i] - ctmp[i]) & 0xFF
return out
def hd(d):
return " ".join("%02X" % e for e in d)
def now():
return int(time.time())
if __name__ == "__main__":
"""main"""
key = [0xC4, 0xC6, 0xC0, 0x92, 0x40, 0x23, 0xDC, 0x96]
params = [0x00] + key
#fp = open(sys.argv[1], "a+b", 0)
fp = open("/dev/hidraw5", "a+b", 0)
HIDIOCSFEATURE_9 = 0xC0094806
set_report = struct.pack('B' * len(params), *params)
fcntl.ioctl(fp, HIDIOCSFEATURE_9, set_report)
values = {}
stamp = now()
while True:
data = list(fp.read(8))
decrypted = decrypt(key, data)
if decrypted[4] != 0x0D or (sum(decrypted[:3]) & 0xFF) != decrypted[3]:
print (hd(data), " => ", hd(decrypted), "Checksum error")
else:
op = decrypted[0]
val = decrypted[1] << 8 | decrypted[2]
values[op] = val
if (0x50 in values) and (0x42 in values):
co2 = values[0x50]
tmp = values[0x42] / 16.0 - 273.15
# check if it's a sensible value
# (i.e. within the measuring range plus some margin)
if (co2 > 5000 or co2 < 0):
co2 = -1
if now() - stamp > 5:
print ("CO2: %4i TMP: %3.1f" % (co2, tmp))
stamp = now()