####################################################################
# This file contains the main code to control the robot.
#
####################################################################
from motors import Motor


def main():
    leftMotor = Motor(17, 18, 22)
    rightMotor = Motor(23, 24, 25)

    while True:
        # Move forward
        leftMotor.forward(50)
        rightMotor.forward(50)

        # Move backward
        wait(10)
        leftMotor.backward(50)
        rightMotor.backward(50)

        # Stop
        leftMotor.stop()
        rightMotor.stop()
        wait(50)


if __name__ == "__main__":
    main()