test: Python route test

This commit is contained in:
Piotr Dec 2024-07-30 22:47:57 +02:00
parent 35e24dcc8e
commit 116b13adcb
Signed by: stawros
GPG key ID: F89F27AD8F881A91

View file

@ -109,6 +109,30 @@ def compass(controller: Controller):
pass
def route(controller: Controller):
print("Route")
controller.set_direction(OutAngle.Left)
controller.set_gps(True)
controller.set_speed(50, 50)
controller.set_distance(1.2, Unit.Kilometres)
sleep(1)
controller.set_distance(1.1, Unit.Kilometres)
sleep(1)
controller.set_distance(1, Unit.Kilometres)
sleep(1)
remaining = 900
while remaining > 0:
controller.set_distance(remaining, Unit.Metres)
sleep(1)
remaining -= 100
controller.set_direction(OutAngle.Right, OutType.Flag)
remaining = 900
while remaining > 0:
controller.set_distance(remaining, Unit.Metres)
sleep(1)
remaining -= 100
if __name__ == '__main__':
import os
name = '/dev/rfcomm0' if os.name != 'nt' else 'COM8'