1
0
mirror of https://github.com/undera/pylgbst.git synced 2020-11-18 19:37:26 -08:00

fix reverse gear

This commit is contained in:
Andrey Pohilko 2017-09-18 21:59:59 +03:00
parent 0ea74dff64
commit c3b0f59803

View File

@ -60,13 +60,14 @@ try:
break
if not message:
time.sleep(0.05)
time.sleep(0.1)
continue
messageString = message.decode("utf-8")
a, b, c = decode_xml(messageString)
sa = int(10 * (c + b / 2.0)) / 10.0
sb = int(10 * (c - b / 2.0)) / 10.0
divider = 2.0 if c > 0 else -2.0
sa = int(10 * (c + b / divider)) / 10.0
sb = int(10 * (c - b / divider)) / 10.0
logging.info("SpeedA=%s, SpeedB=%s", sa, sb)
robot.motor_AB.constant(sa, sb, async=True)
time.sleep(0.5)