✨
This commit is contained in:
@ -6,19 +6,21 @@ POWER = 70
|
||||
TURN_T = 0.079 # 10 degrees
|
||||
DRIVE_A = 16 # 10 centimeter drive at power 1
|
||||
|
||||
RIGHT_WHEEL_OFFSET = 4
|
||||
|
||||
CLOCKWISE_OFFSET = 0.96
|
||||
|
||||
def square(arlo, drive_t):
|
||||
while True:
|
||||
# Driving forward
|
||||
arlo.go_diff(POWER, POWER+4, 1, 1)
|
||||
arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 1, 1)
|
||||
sleep(drive_t * 10)
|
||||
arlo.stop()
|
||||
|
||||
sleep(1)
|
||||
|
||||
# Turning 90 degrees
|
||||
arlo.go_diff(POWER, POWER+4, 0, 1)
|
||||
arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 0, 1)
|
||||
sleep(TURN_T * 9)
|
||||
arlo.stop()
|
||||
|
||||
|
Reference in New Issue
Block a user