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)
finally: termios.tcsetattr(fd, termios.TCSADRAIN, old_settings) return ch if __name__ == "__main__": while(True): key = getKey() d_logger.debug("Key %s pressed", key) if(key == 'c'): c.motors.stop() 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()