import time import os import sys from tiberius.control.control import Control c = Control() stop_distance = 20 # Drive around em301 if __name__ == '__main__': while(True): try: c.motors.setSpeedPercent(100) c.driveForwardUntilWall(30) c.driveBackwardUntilWall(30) except KeyboardInterrupt: c.motors.stop() sys.exit(0)
sys.exit(0) elif(key == 'w'): c.motors.setSpeedPercent(50) c.driveForwardUntilWall(5,50) elif(key == 'W'): c.motors.setSpeedPercent(100) c.motors.moveForward() elif(key == 'a'): c.motors.setSpeedPercent(40) c.motors.turnLeft() elif(key == 'A'): c.motors.setSpeedPercent(100) c.motors.turnLeft() elif(key == 's'): c.motors.setSpeedPercent(50) c.driveBackwardUntilWall(5,50) elif(key == 'S'): c.motors.setSpeedPercent(100) c.motors.moveBackward() elif(key == 'd'): c.motors.setSpeedPercent(50) c.motors.turnRight() elif(key == 'D'): c.motors.setSpeedPercent(100) c.motors.turnRight() elif(key == ' '): c.motors.stop() time.sleep(0.1) # Use ultrasonics to prevent collisions. if ultras.frontHit() and c.motors.state == MotorState.FORWARD: