30 lines
635 B
Python
30 lines
635 B
Python
####################################################################
|
|
# 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()
|