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)
