30 lines
638 B
Python
30 lines
638 B
Python
####################################################################
|
|
# This file contains the main code to control the robot.
|
|
#
|
|
####################################################################
|
|
from motors import TMotor
|
|
|
|
|
|
def main():
|
|
leftMotor = TMotor(17, 18, 22)
|
|
rightMotor = TMotor(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()
|