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:17:31 +02:00
parent 997a032b8c
commit 8851f2d39d
1 changed files with 19 additions and 12 deletions
Download Patch File Download Diff File Expand all files Collapse all files

31
square.py
View File

@ -4,28 +4,35 @@ import robot
DRIVE_A = 5.3 # 10 degrees turn at power 1 DRIVE_A = 5.3 # 10 degrees turn at power 1
TURN_A = 16 # 10 centimeter drive at power 1 TURN_A = 16 # 10 centimeter drive at power 1
def square(arlo, power, turn_t, drive_t):
while True:
# Driving forward
arlo.go_diff(power, power, 1, 1)
sleep(drive_t * 10)
arlo.stop()
# Turning 90 degrees
arlo.go_diff(power, power, 1, 0)
sleep(turn_t * 9)
arlo.stop()
def main(): def main():
# Gets the power for the robot
power = input("Power (64):") power = input("Power (64):")
if power == "": if power == "":
power = 64 power = 64
else: else:
power = int(power) power = int(power)
turn_t = (DRIVE_A / power) * 9 # 10 degrees turn at given power # Calculates sleep times for the robot
drive_t = (TURN_A / power) * 10 # 10 centimeter drive at given power turn_t = DRIVE_A / power # 10 degrees turn at given power
drive_t = TURN_A / power # 10 centimeter drive at given power
# Initializes the robot and runs the
arlo = robot.Robot() arlo = robot.Robot()
try: try:
while True: square(arlo, power, turn_t, drive_t)
# Driving forward
arlo.go_diff(power, power, 1, 1)
sleep(drive_t)
arlo.stop()
# Turning 90 degrees
arlo.go_diff(power, power, 1, 0)
sleep(turn_t)
arlo.stop()
except KeyboardInterrupt: except KeyboardInterrupt:
arlo.stop() arlo.stop()