import setup from setup import RPL import RoboPiLib as RPL sensor_pin = 5 RPL.pinMode(sensor_pin, RPL.INPUT) def analogRead(pin): putPacket(ANREAD, bytearray([5]), 1) buff = getPacket() return int(buff[3][1]) | (int(buff[3][2]) << 8) while True: if RPL.analogRead(5) > 450 and RPL.analogRead(3) > 450: RPL.servoWrite(2, 1490) RPL.servoWrite(1, 300) print "ok" if 400 > RPL.analogRead(5) and RPL.analogRead(3) > 250: RPL.servoWrite(2, 2000) RPL.servoWrite(1, 1470) print "yeah" if RPL.analogRead(5) >= 400 and RPL.analogRead(5) <= 450: RPL.servoWrite(2, 2000) RPL.servoWrite(1, 300) print "gratata" if RPL.analogRead(3) < 250: RPL.servoWrite(2, 2000) RPL.servoWrite(1, 0) if RPL.digitalRead(17) == 0:
def DT_PWM_Speedrange(): ServoR = int(raw_input(0)) RPL.pinMode(ServoR, RPL.PWM) ServoL = int(raw_input(1)) RPL.pinMode(ServoL, RPL.PWM)