def motorStatus(x): if x == 1: RPL.servoWrite(0, 2000) RPL.servoWrite(1, 1000) if x == 0: RPL.servoWrite(0, 0) RPL.servowrite(1, 0)
import setup import RoboPiLib as RPL RPL.RoboPiInit("/dev/ttyAMA0", 115200) motorL = 1 motorR = 0 sensor_pin = 17 RPL.servowrite(motorR, 2000) RPL.servowrite(motorL, 1000) RPL.pinmode(sensor_pin, RPL.INPUT) while RPL.digitalRead(sensor_pin) == 1: RPL.servowrite(motorR, 2000) RPL.servowrite(motorL, 1000) else: RPL.servowrite(motorR, 0) RPL.servowrite(motorL)