コード例 #1
0
ファイル: mot.py プロジェクト: GBhack/PFE-VA_Dev
    CONFIG_FILE = open(path.expanduser('~/.robotConf'), 'r')
    ROBOT_ROOT = CONFIG_FILE.read().strip()
    CONFIG_FILE.close()

    import Adafruit_BBIO_SIM.GPIO as GPIO
    import Adafruit_BBIO.PWM as PWM

    #Simulator setup
    PWM.pin_association(GPIODEF.ENGINES["left"]["PWM"], 'left motor\'s PWM')
    PWM.pin_association(GPIODEF.ENGINES["right"]["PWM"], 'right motor\'s PWM')
    GPIO.pin_association(GPIODEF.ENGINES["left"]["forward"], 'left motor\'s forward pin')
    GPIO.pin_association(GPIODEF.ENGINES["right"]["forward"], 'right motor\'s forward pin')
    GPIO.pin_association(GPIODEF.ENGINES["left"]["backward"], 'left motor\'s backward pin')
    GPIO.pin_association(GPIODEF.ENGINES["right"]["backward"], 'right motor\'s backward pin')
    GPIO.setup_behavior('print')
    PWM.setup_behavior('print')
else:
    ROBOT_ROOT = ''
    print('It seems like you are NOT working on an actual robot. \
You should set up a debugging environment before running any code (see documentation)')

#Logging Initialization :
LOGGER = robotLogger("FL > mot", ROBOT_ROOT+'logs/fl/')

###########################################################################
#                           I/O Initialization :                          #
###########################################################################

MOTOR_LEFT = GPIODEF.ENGINES["left"]
MOTOR_RIGHT = GPIODEF.ENGINES["right"]