iii
This commit is contained in:
Harald Hoyer
parent
940fd3ca3a
commit
24f8d3fda4
220
iconsole.py
220
iconsole.py
|
|
@ -1,62 +1,3 @@
|
|||
import serial,struct
|
||||
from time import sleep
|
||||
from binascii import hexlify
|
||||
want = struct.pack('BBBBB', 0xf0, 0xb0, 0x01, 0x01, 0xa2)
|
||||
|
||||
port = serial.Serial('/dev/rfcomm0')
|
||||
print "OK"
|
||||
got = None
|
||||
while got != want:
|
||||
port.write(struct.pack('BBBBB', 0xf0, 0xa0, 0x01, 0x01, 0x92))
|
||||
sleep(0.5)
|
||||
got = port.read_all()
|
||||
print hexlify(got)
|
||||
|
||||
print "init done"
|
||||
port.write(struct.pack('BBBBB', 0xf0, 0xa1, 0x01, 0x01, 0x93))
|
||||
sleep(0.5)
|
||||
print hexlify(port.read_all())
|
||||
port.write(struct.pack('BBBBB', 0xf0, 0xa0, 0x01, 0x01, 0x92))
|
||||
sleep(0.5)
|
||||
print hexlify(port.read_all())
|
||||
port.write(struct.pack('BBBBB', 0xf0, 0xa0, 0x01, 0x01, 0x92))
|
||||
sleep(0.5)
|
||||
print hexlify(port.read_all())
|
||||
port.write(struct.pack('BBBBB', 0xf0, 0xa0, 0x01, 0x01, 0x92))
|
||||
sleep(0.5)
|
||||
print hexlify(port.read_all())
|
||||
port.write(struct.pack('BBBBB', 0xf0, 0xa0, 0x01, 0x01, 0x92))
|
||||
sleep(0.5)
|
||||
print hexlify(port.read_all())
|
||||
port.write(struct.pack('BBBBB', 0xf0, 0xa0, 0x01, 0x01, 0x92))
|
||||
sleep(0.5)
|
||||
print hexlify(port.read_all())
|
||||
port.write(struct.pack('BBBBBB', 0xf0, 0xa3, 0x01, 0x01, 0x01, 0x96))
|
||||
sleep(0.5)
|
||||
print hexlify(port.read_all())
|
||||
port.write(struct.pack('BBBBBBBBBBBBBBB', 0xf0, 0xa4, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0xa0))
|
||||
sleep(0.5)
|
||||
print hexlify(port.read_all())
|
||||
port.write(struct.pack('BBBBBB', 0xf0, 0xa5, 0x01, 0x01, 0x02, 0x99))
|
||||
sleep(0.5)
|
||||
print hexlify(port.read_all())
|
||||
while True:
|
||||
port.write(struct.pack('BBBBB', 0xf0, 0xa2, 0x01, 0x01, 0x94))
|
||||
sleep(0.5)
|
||||
got = port.read_all()
|
||||
if len(got) == 21:
|
||||
gota = struct.unpack('BBBBBBBBBBBBBBBBBBBBB', got)
|
||||
time = "%02d:%02d:%02d:%02d" % (gota[2]-1, gota[3]-1, gota[4]-1, gota[5]-1)
|
||||
speed = "V: % 3.1f km/h" % ((100*(gota[6]-1) + gota[7] -1) / 10.0)
|
||||
rpm = "RPM: % 3d" % ((100*(gota[8]-1) + gota[9] -1))
|
||||
distance = "D: % 3.1f km" % ((100*(gota[10]-1) + gota[11] -1) / 10.0)
|
||||
calories = "% 3d kcal" % ((100*(gota[12]-1) + gota[13] -1))
|
||||
hf = "HF % 3d" % ((100*(gota[14]-1) + gota[15] -1))
|
||||
watt = "% 3.1f W" % ((100*(gota[16]-1) + gota[17] -1) / 10.0)
|
||||
lvl = "L: %d" % (gota[18] -1)
|
||||
print "%s - %s - %s - %s - %s - %s - %s - %s" % (time, speed, rpm, distance, calories, hf, watt, lvl)
|
||||
|
||||
port.close()
|
||||
# f0:b2 01:01:04:06 03:11 01:3b 01:07 01:0d 01:01 0f:33 09 02
|
||||
# T: 3:05 21.0km/h RPM58 D:0.6 cal 12 HF 0 W:1450 LVL8
|
||||
#
|
||||
|
|
@ -84,8 +25,167 @@ port.close()
|
|||
# f0:a6:01:01:02:9a - C: LEVEL 1
|
||||
|
||||
# f0:a5:01:01:02:99 - C: START
|
||||
# f0:b5:01:01:02:a9 - M: STOPPED
|
||||
# f0:b5:01:01:02:a9 - M: STARTED
|
||||
|
||||
# f0:a5:01:01:04:9b - C: STOP
|
||||
# f0:b5:01:01:04:ab - M: STOPPED
|
||||
|
||||
# 93 rpm - 100 W - lvl 1 1.075
|
||||
# 77 rpm - 100 W - lvl 2 1.3
|
||||
# 48 rpm - 143.4 W - lvl 12 2.98
|
||||
|
||||
# 23.5 W pro Stufe auf 81
|
||||
|
||||
# 12 - 350.8 - 82
|
||||
# 357.7 83
|
||||
# 364.6 84 6.9 pro rpm
|
||||
|
||||
import serial,struct
|
||||
from time import sleep
|
||||
from binascii import hexlify
|
||||
|
||||
INIT_A0 = struct.pack('BBBBB', 0xf0, 0xa0, 0x02, 0x02, 0x94)
|
||||
PING = struct.pack('BBBBB', 0xf0, 0xa0, 0x01, 0x01, 0x92)
|
||||
PONG = struct.pack('BBBBB', 0xf0, 0xb0, 0x01, 0x01, 0xa2)
|
||||
STATUS = struct.pack('BBBBB', 0xf0, 0xa1, 0x01, 0x01, 0x93)
|
||||
INIT_A3 = struct.pack('BBBBBB', 0xf0, 0xa3, 0x01, 0x01, 0x01, 0x96)
|
||||
INIT_A4 = struct.pack('BBBBBBBBBBBBBBB', 0xf0, 0xa4, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0xa0)
|
||||
START = struct.pack('BBBBBB', 0xf0, 0xa5, 0x01, 0x01, 0x02, 0x99)
|
||||
STOP = struct.pack('BBBBBB', 0xf0, 0xa5, 0x01, 0x01, 0x04, 0x9b)
|
||||
READ = struct.pack('BBBBB', 0xf0, 0xa2, 0x01, 0x01, 0x94)
|
||||
|
||||
port = serial.Serial('/dev/rfcomm3')
|
||||
print "OK"
|
||||
import signal
|
||||
|
||||
class GracefulInterruptHandler(object):
|
||||
|
||||
def __init__(self, sig=signal.SIGINT):
|
||||
self.sig = sig
|
||||
|
||||
def __enter__(self):
|
||||
|
||||
self.interrupted = False
|
||||
self.released = False
|
||||
|
||||
self.original_handler = signal.getsignal(self.sig)
|
||||
|
||||
def handler(signum, frame):
|
||||
self.release()
|
||||
self.interrupted = True
|
||||
|
||||
signal.signal(self.sig, handler)
|
||||
|
||||
return self
|
||||
|
||||
def __exit__(self, type, value, tb):
|
||||
self.release()
|
||||
|
||||
def release(self):
|
||||
|
||||
if self.released:
|
||||
return False
|
||||
|
||||
signal.signal(self.sig, self.original_handler)
|
||||
|
||||
self.released = True
|
||||
|
||||
return True
|
||||
|
||||
def send_ack(packet, expect=None, plen=0):
|
||||
if expect == None:
|
||||
expect = 0xb0 | (ord(packet[1]) & 0xF)
|
||||
|
||||
if plen == 0:
|
||||
plen = len(packet)
|
||||
|
||||
got = None
|
||||
while got == None:
|
||||
sleep(0.1)
|
||||
port.read_all()
|
||||
port.write(packet)
|
||||
port.flush()
|
||||
#print "->" + hexlify(packet)
|
||||
i = 0
|
||||
while got == None and i < 6:
|
||||
i+=1
|
||||
sleep(0.1)
|
||||
got = port.read_all()
|
||||
if len(got) == plen:
|
||||
#print "<-" + hexlify(got)
|
||||
pass
|
||||
else:
|
||||
if len(got) > 0:
|
||||
#print "Got len == %d" % len(got)
|
||||
pass
|
||||
got = None
|
||||
|
||||
if got and len(got) >= 3 and got[0] == packet[0] and ord(got[1]) == expect:
|
||||
break
|
||||
got = None
|
||||
return got
|
||||
|
||||
def send_level(lvl):
|
||||
packet = struct.pack('BBBBBB', 0xf0, 0xa6, 0x01, 0x01, lvl+1, (0xf0+0xa6+3+lvl) & 0xFF)
|
||||
got = send_ack(packet)
|
||||
return got
|
||||
|
||||
|
||||
#send_level(10)
|
||||
|
||||
i = 0
|
||||
with GracefulInterruptHandler() as h:
|
||||
send_ack(PING)
|
||||
print "ping done"
|
||||
|
||||
send_ack(INIT_A0, expect=0xb7, plen=6)
|
||||
print "A0 done"
|
||||
|
||||
for i in range(0, 5):
|
||||
send_ack(PING)
|
||||
print "ping done"
|
||||
|
||||
send_ack(STATUS, plen=6)
|
||||
print "status done"
|
||||
|
||||
send_ack(PING)
|
||||
print "ping done"
|
||||
|
||||
send_ack(INIT_A3)
|
||||
print "A3 done"
|
||||
|
||||
send_ack(INIT_A4)
|
||||
print "A4 done"
|
||||
|
||||
send_ack(START)
|
||||
print "START done"
|
||||
|
||||
while True:
|
||||
if h.interrupted:
|
||||
break
|
||||
sleep(0.4)
|
||||
i+=1
|
||||
# if i % 20 == 2:
|
||||
# send_level((i/20) +1)
|
||||
|
||||
got = send_ack(READ, plen=21)
|
||||
if len(got) == 21:
|
||||
gota = struct.unpack('BBBBBBBBBBBBBBBBBBBBB', got)
|
||||
time = "%02d:%02d:%02d:%02d" % (gota[2]-1, gota[3]-1, gota[4]-1, gota[5]-1)
|
||||
speed = "V: % 3.1f km/h" % ((100*(gota[6]-1) + gota[7] -1) / 10.0)
|
||||
rpm = "% 3d RPM" % ((100*(gota[8]-1) + gota[9] -1))
|
||||
distance = "D: % 3.1f km" % ((100*(gota[10]-1) + gota[11] -1) / 10.0)
|
||||
calories = "% 3d kcal" % ((100*(gota[12]-1) + gota[13] -1))
|
||||
hf = "HF % 3d" % ((100*(gota[14]-1) + gota[15] -1))
|
||||
watt = "% 3.1f W" % ((100*(gota[16]-1) + gota[17] -1) / 10.0)
|
||||
lvl = "L: %d" % (gota[18] -1)
|
||||
print "%s - %s - %s - %s - %s - %s - %s - %s" % (time, speed, rpm, distance, calories, hf, watt, lvl)
|
||||
|
||||
send_ack(STOP)
|
||||
print "STOP done"
|
||||
|
||||
for i in range(0, 5):
|
||||
send_ack(PING)
|
||||
print "ping done"
|
||||
|
||||
port.close()
|
||||
|
|
|
|||
Loading…
Reference in a new issue