NikolajDanger/Roboteksperimentarium
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

turn_test.py

Browse Source
This commit is contained in:
NikolajDanger
2022-09-07 13:41:39 +02:00
parent 26ddb19aff
commit 82f4719266
1 changed files with 7 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files

10
square.py
View File

@ -27,24 +27,28 @@ def clockwise_square(arlo):
sleep(1) sleep(1)
def counter_square(arlo): def counter_square(arlo):
arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 0, 1)
sleep(TURN_T * 0.5)
arlo.stop()
for _ in range(4): for _ in range(4):
# Driving forward # Driving forward
arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 1, 1) arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 1, 1)
sleep(DRIVE_T * 10) sleep(DRIVE_T * 10)
arlo.stop() arlo.stop()
sleep(1) sleep(0.5)
# Turning 90 degrees # Turning 90 degrees
arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 0, 1) arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 0, 1)
sleep(TURN_T * 10) sleep(TURN_T * 10)
arlo.stop() arlo.stop()
sleep(0.5) sleep(0.2)
arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 1, 0) arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 1, 0)
sleep(TURN_T) sleep(TURN_T)
arlo.stop() arlo.stop()
sleep(1) sleep(0.5)
def main(): def main():
# Initializes the robot and runs the # Initializes the robot and runs the