feat: fixed logic of drive

This commit is contained in:
2020-05-18 20:11:46 +02:00
parent f86beeaecb
commit c6b33683b7

View File

@@ -48,10 +48,10 @@ class WallE:
velocity_r = sin_angle * force
velocity_l = cos_angle * force
elif cos_angle < 0 and sin_angle > 0:
if cos_angle < sin_angle:
if abs(cos_angle) < sin_angle:
velocity_r = 1 - sin_angle * force
velocity_l = sin_angle * force
elif cos_angle > abs(sin_angle):
elif cos_angle > sin_angle:
velocity_r = sin_angle * force
velocity_l = cos_angle * force
else: