Python Control.driveForwardUntilWall 예제들

예제 #1

파일: back_and_forth_stop.py 프로젝트: IonSystems/tiberius-robot

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

파일: ultras_control.py 프로젝트: IonSystems/tiberius-robot

    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()