def step():
#io.setRotational(0.5)
vNeck, vLeft, vRight, _ = io.getAnalogInputs()
#print vNeck,'Left:',vLeft,'Right:',vRight, 'Difference: ', vRight-vLeft
#io.setForward(0)
#io.setRotational(0)
#move robot backwards or forwards at a rate proportional to the amount of light the photodiodes are reading
average = (vLeft + vRight) / 2
print vLeft, vRight, average
if vLeft > 0.18 or vRight > 0.18:
io.setForward(-average / 10)
seekLight(vNeck)
print "light is too close"
elif vLeft > 0.16 or vRight > 0.16:
seekLight(vNeck)
io.setForward(0)
print "TARGET IN SIGHT"
elif vLeft > 0.155 or vRight > 0.155:
seekLight(vNeck)
io.setForward(average / 10)
print "seeking light"
else:
io.setRotational(0)
io.setForward(0)
print "light is off"
def step():
voltage,_,_,_ = io.getAnalogInputs()
x,y,t = io.getPosition()
robot.voltages.append(voltage)
robot.distances.append(-x)
io.setForward(5*(current_distance-0.5))
def step():
voltage, _, _, _ = io.getAnalogInputs()
x, y, t = io.getPosition()
robot.voltages.append(voltage)
robot.distances.append(-x)
io.setForward(5 * (current_distance - 0.5))
def step():
vNeck,vLeft,vRight,vCommon = io.getAnalogInputs()
if lightExists(vLeft, vRight):
forward = 0.1 * (desiredDistance - max(vLeft, vRight))
rotational = vLeft - vRight
io.setForward(forward)
io.setRotational(rotational)
else:
wall_follower_step()
def step():
distance = distanceFromVoltage(io.getAnalogInputs()[0])
print io.getSonars()[3], distance
io.setForward((distance-0.5)*2) #replace with your code
def step():
vNeck,vLeft,vRight,_ = io.getAnalogInputs()
print 'Neck:',vNeck,'Left:',vLeft,'Right:',vRight
pass #Your code here
io.setForward(0)
io.setRotational(0)
