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)
