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)
예제 #2
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: