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

square

Browse Source
This commit is contained in:
NikolajDanger
2022-09-07 11:14:07 +02:00
parent c52cb9b2ba
commit 997a032b8c
1 changed files with 15 additions and 7 deletions
Download Patch File Download Diff File Expand all files Collapse all files

22
square.py
View File

@@ -1,23 +1,30 @@
from time import sleep from time import sleep
import robot import robot
POWER = 64 DRIVE_A = 5.3 # 10 degrees turn at power 1
TURN_TIME = 0.75 TURN_A = 16 # 10 centimeter drive at power 1
DRIVE_TIME = 2.5
def main(): def main():
power = input("Power (64):")
if power == "":
power = 64
else:
power = int(power)
turn_t = (DRIVE_A / power) * 9 # 10 degrees turn at given power
drive_t = (TURN_A / power) * 10 # 10 centimeter drive at given power
arlo = robot.Robot() arlo = robot.Robot()
try: try:
while True: while True:
# Driving forward # Driving forward
arlo.go_diff(POWER, POWER, 1, 1) arlo.go_diff(power, power, 1, 1)
sleep(DRIVE_TIME) sleep(drive_t)
arlo.stop() arlo.stop()
# Turning 90 degrees # Turning 90 degrees
arlo.go_diff(POWER, POWER, 1, 0) arlo.go_diff(power, power, 1, 0)
sleep(TURN_TIME) sleep(turn_t)
arlo.stop() arlo.stop()
except KeyboardInterrupt: except KeyboardInterrupt:
@@ -25,4 +32,5 @@ def main():
if __name__ == "__main__": if __name__ == "__main__":
main() main()