def right():
Motors.still()
Servo.turn_right()
Motors.forward()
time.sleep(3)
Motors.still()
Servo.center()
def main():
#print('Left Sensor ', LeftSensor.getLastEvent(), '\t Center Sensor ', CenterSensor.getLastEvent(), '\t Right Sensor ', RightSensor.getLastEvent())
#time.sleep(1)
Motors.forward()
if LeftSensor.getLastEvent() >= 500 and RightSensor.getLastEvent() >= 500:
#Execute ppark
Motors.still()
Motors.forward()
time.sleep(1)
Motors.still()
Servo.turn_left()
Motors.backward()
time.sleep(3)
Servo.center()
Servo.turn_right()
Motors.backward()
time.sleep(2)
Motors.still()
Motors.forward()
time.sleep(2)
Motors.still()
Servo.center()
os.system("flite -t 'Delta Task ended'")
LeftSensor.stop()
CenterSensor.stop()
RightSensor.stop()
def turnAround(): Motors.still() Servo.turn_right() Motors.forward() time.sleep(6) Motors.still() Servo.center()
def turnLeft(): Motors.still() Servo.turn_left() Motors.forward() time.sleep(3) Motors.still() Servo.center()
def main():
os.system("flite -t 'Alpha Task started'")
time.sleep(5) #Wait 5 seconds
Motors.forward()
time.sleep(2)
Servo.turn_right()
time.sleep(2)
Servo.center()
Motors.still()
Servo.cleanup()
Motors.stop()
os.system("flite -t 'Alpha Task ended'")
blocks = BlockArray(100)
frame = 0
Motors.still()
while 1:
Motors.forward()
count = pixy.ccc_get_blocks(100, blocks)
if count > 0:
print('frame %3d:' % (frame))
frame = frame + 1
for index in range(0, count):
#print '[BLOCK: SIG=%d X=%3d Y=%3d WIDTH=%3d HEIGHT=%3d]' % (blocks[index].m_signature, blocks[index].m_x, blocks[index].m_y, blocks[index].m_width, blocks[index].m_height)
if blocks[index].m_x >= 200:
print("right")
Servo.turn_right()
elif blocks[index].m_x <= 100:
print("left")
Servo.turn_left()
elif blocks[index].m_x >= 100 and blocks[index].m_x <= 200:
print("center")
Servo.center()
## if blocks[index].m_signature == 1:
## print("Red Detected")
## Motors.forward()
## elif blocks[index].m_signature == 2:
## print("Yellow Detected")
## backwards()
