diff --git a/wiggle.py b/wiggle.py new file mode 100644 index 0000000..e3dd98b --- /dev/null +++ b/wiggle.py @@ -0,0 +1,35 @@ +from time import sleep +import robot + +POWER = 70 + +TURN_T = 0.079 # 10 degrees +DRIVE_T = 0.22 # 10 centimeter + +RIGHT_WHEEL_OFFSET = 4 + +CLOCKWISE_OFFSET = 0.82 + +def loop(arlo): + arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 1, 0) + sleep(TURN_T * CLOCKWISE_OFFSET) + arlo.stop() + sleep(0.2) + arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 0, 1) + sleep(TURN_T) + arlo.stop() + +def main(): + # Initializes the robot and runs the + arlo = robot.Robot() + + try: + loop(arlo) + + except KeyboardInterrupt: + arlo.stop() + + +if __name__ == "__main__": + + main()