✨
This commit is contained in:
@ -1,7 +1,7 @@
|
|||||||
from time import sleep
|
from time import sleep
|
||||||
import robot
|
import robot
|
||||||
|
|
||||||
POWER = 70
|
POWER = 127
|
||||||
|
|
||||||
TURN_T = 0.079 # 10 degrees
|
TURN_T = 0.079 # 10 degrees
|
||||||
DRIVE_T = 0.22 # 10 centimeter
|
DRIVE_T = 0.22 # 10 centimeter
|
||||||
@ -20,57 +20,6 @@ def loop(arlo):
|
|||||||
sleep(DRIVE_T * 26)
|
sleep(DRIVE_T * 26)
|
||||||
arlo.stop()
|
arlo.stop()
|
||||||
|
|
||||||
def clockwise_square(arlo):
|
|
||||||
arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 0, 1)
|
|
||||||
sleep(TURN_T * 0.5)
|
|
||||||
arlo.stop()
|
|
||||||
sleep(0.5)
|
|
||||||
|
|
||||||
for _ in range(4):
|
|
||||||
# Driving forward
|
|
||||||
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 + RIGHT_WHEEL_OFFSET, 1, 0)
|
|
||||||
sleep(TURN_T * 10 * CLOCKWISE_OFFSET)
|
|
||||||
arlo.stop()
|
|
||||||
sleep(0.2)
|
|
||||||
arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 0, 1)
|
|
||||||
sleep(TURN_T)
|
|
||||||
arlo.stop()
|
|
||||||
|
|
||||||
|
|
||||||
sleep(1)
|
|
||||||
|
|
||||||
def counter_square(arlo):
|
|
||||||
arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 0, 1)
|
|
||||||
sleep(TURN_T * 0.5)
|
|
||||||
arlo.stop()
|
|
||||||
sleep(0.5)
|
|
||||||
|
|
||||||
for _ in range(4):
|
|
||||||
# Driving forward
|
|
||||||
arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 1, 1)
|
|
||||||
sleep(DRIVE_T * 10)
|
|
||||||
arlo.stop()
|
|
||||||
|
|
||||||
sleep(0.5)
|
|
||||||
|
|
||||||
# Turning 90 degrees
|
|
||||||
arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 0, 1)
|
|
||||||
sleep(TURN_T * 10)
|
|
||||||
arlo.stop()
|
|
||||||
sleep(0.2)
|
|
||||||
arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 1, 0)
|
|
||||||
sleep(TURN_T)
|
|
||||||
arlo.stop()
|
|
||||||
|
|
||||||
sleep(0.5)
|
|
||||||
|
|
||||||
def main():
|
def main():
|
||||||
# Initializes the robot and runs the
|
# Initializes the robot and runs the
|
||||||
arlo = robot.Robot()
|
arlo = robot.Robot()
|
||||||
|
Reference in New Issue
Block a user