This commit is contained in:
NikolajDanger
2022-09-07 12:02:45 +02:00
parent 2b19bc117d
commit 393e3e3ea2
2 changed files with 7 additions and 20 deletions

View File

@ -4,20 +4,20 @@ import robot
TURN_A = 5.3 # 10 degrees turn at power 1
DRIVE_A = 16 # 10 centimeter drive at power 1
RIGHT_WHEEL_OFFSET = 4
TURN_COUNTER_OFFSET = 1.042
def square(arlo, power, turn_t, drive_t):
while True:
# Driving forward
arlo.go_diff(power, power + RIGHT_WHEEL_OFFSET, 1, 1)
arlo.go_diff(power, power, 1, 1)
sleep(drive_t * 10)
arlo.stop()
sleep(1)
# Turning 90 degrees
arlo.go_diff(power, power + RIGHT_WHEEL_OFFSET, 0, 1)
sleep(turn_t * 9)
arlo.go_diff(power, power, 0, 1)
sleep(turn_t * 9 * TURN_COUNTER_OFFSET)
arlo.stop()
sleep(1)