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()