def sensorcont():
back_sensor = 16
left_sensor = 18
rt_sensor = 17
rt_wheel = 0
lft_wheel = 1
forward = 1000
backward = 2000
RPL.servoWrite(0, 0)
command = raw_input("> ")
if command == "forward":
RPL.servoWrite(rt_wheel, backward)
RPL.servoWrite(lft_wheel, forward)
stop = 4
while stop != 1:
cease = raw_input("> ")
if RPL.readDistance(rt_sensor) < 45000:
RPL.servoWrite(lft_wheel, 0)
if RPL.readDistance(rt_sensor) > 70000:
RPL.servoWrite(lft_wheel, 1000)
RPL.servoWrite(rt_wheel, 0)
elif RPL.readDistance(rt_sensor) < 70000 and RPL.readDistance(
rt_sensor) > 45000:
RPL.servoWrite(lft_wheel, 1000)
RPL.servoWrite(rt_wheel, 2000)
elif cease == "stop":
stop = 1
RPl.servoWrite(0, 0)
RPL.servoWrite(1, 0)
import setup
from setup import RPL
import post_to_web as PTW
import time
left_sensor = 15
rear = 16
rt_wheel = 0
lft_wheel = 1
forward = 1000
backward = 2000
condit = 7
x = 0
while condit != 18:
RPL.servoWrite(1, 2000)
RPL.servoWrite(2, 1000)
if RPL.readDistance(16) < 1000:
RPL.servoWrite(2, 0)
RPL.servoWrite(1, 0)
condit = 18
if x >= 10:
z = 3
RPL.servoWrite(1, 2000)
RPL.servoWrite(2, 0000)
time.sleep(.5)
RPL.servoWrite(1, 2500)
RPL.servoWrite(2, 1499)
time.sleep(.5)
RPL.servoWrite(1, 1500)
RPL.servoWrite(2, 1499)
while z == 3:
if RPL.readDistance(rear) < 1000:
def Distance():
return RPL.readDistance(16)
def motorRight():
RPL.servoWrite(1, 2000)
RPL.servoWrite(2, 000)
back_sensor = 16
rt_wheel = 0
lft_wheel = 1
forward = 1000
backward = 2000
condit = 7
x = 0
while condit != 16:
motorForw()
if RPL.readDistance(17) < 1000:
condit = 16
if Distance() > 50000:
motorLeft()
time.sleep(.5)
elif Distance() < 10000:
motorRight()
time.sleep(.5)
else:
x += 1
motorForw()
motorstop()
print x #prints the total number of times a sycle went with a Distance value imbetween 50000 and 10000
import setup
from setup import RPL
rightsensor = 23
rightmotor = 0
leftmotor = 1
while True:
if RPL.readDistance(rightsensor) < 40000:
RPL.servoWrite(rightmotor, 2000)
else:
RPL.servoWrite(rightmotor, 0)
