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:
parent
0ea74dff64
commit
c3b0f59803
@ -60,13 +60,14 @@ try:
|
|||||||
break
|
break
|
||||||
|
|
||||||
if not message:
|
if not message:
|
||||||
time.sleep(0.05)
|
time.sleep(0.1)
|
||||||
continue
|
continue
|
||||||
|
|
||||||
messageString = message.decode("utf-8")
|
messageString = message.decode("utf-8")
|
||||||
a, b, c = decode_xml(messageString)
|
a, b, c = decode_xml(messageString)
|
||||||
sa = int(10 * (c + b / 2.0)) / 10.0
|
divider = 2.0 if c > 0 else -2.0
|
||||||
sb = int(10 * (c - b / 2.0)) / 10.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)
|
logging.info("SpeedA=%s, SpeedB=%s", sa, sb)
|
||||||
robot.motor_AB.constant(sa, sb, async=True)
|
robot.motor_AB.constant(sa, sb, async=True)
|
||||||
time.sleep(0.5)
|
time.sleep(0.5)
|
||||||
|
Loading…
x
Reference in New Issue
Block a user