Trabajo Final

Taller de Robtica educ.ar 2015

import math
import pygame
from miniSim import MiniSim
from miniSim import MobileRobot
miniSim = MiniSim()
robot = miniSim.robot0
def go():
miniSim.resetRobot(robot)
cont1 = 1
ROJO = 0
VERDE = 0
AZUL = 0
TOTAL = ((AZUL+ROJO)+VERDE)
FIN = 0
C_ROJO = 0
C_AZUL = 0
C_VERDE = 0
robot.move(-(150))
robot.rotate(-(90))
robot.move(150)
robot.penWidth = 60
#Se dibujan tres manchas de colores distintos (R, B, G)
for _i in range(3):
if ((int)(cont1)==(int)(1)):
robot.penColor = (255,0,0)
if ((int)(cont1)==(int)(2)):
robot.penColor = (0,0,255)
if ((int)(cont1)==(int)(3)):
robot.penColor = (0,255,0)
robot.penDown()
for _i in range(45):
robot.move(1)
robot.rotate(8)
robot.penUp()
cont1 = (cont1+1)
robot.rotate(120)
robot.move(300)
#Hasta aqui dibuja las tres manchas
#///////////////////////////////
#Se dibuja un poligono del cual no podra salir nuestro robot
robot.move(90)
robot.rotate(90)
robot.penWidth = 30
robot.penColor = (0,0,0)
robot.penDown()
for _i in range(12):
robot.move(150)
robot.rotate(30)
robot.penUp()
#Se posiciona el robot dentro del poligono
robot.rotate(45)
Cristian Oscar Viola

robot.move(350)
#Mientras no pase por las tres manchas hacer...
while (FIN!=3):
while robot.readCenterColorSensor() != (0,0,0):
robot.move(2)
if robot.readCenterColorSensor() == (255,0,0):
ROJO = (ROJO+robot.random())
C_ROJO = 1
if robot.readCenterColorSensor() == (0,0,255):
AZUL = (AZUL+robot.random())
C_AZUL = 1
if robot.readCenterColorSensor() == (0,255,0):
VERDE = (VERDE+robot.random())
C_VERDE = 1
if robot.readCenterColorSensor() == (0,0,0):
FIN = (FIN-1)
robot.move(-(10))
robot.rotate((robot.random()*1.5))
#Contador para detectar fin de ciclo
FIN = ((C_ROJO+C_AZUL)+C_VERDE)
#Muestra puntaje obtenido
print 'TOTAL ROJO'
print ROJO
print 'TOTAL AZUL'
print AZUL
print 'TOTAL VERDE'
print VERDE
TOTAL = ((ROJO+AZUL)+VERDE)
print 'TOTAL PUNTOS'
print TOTAL
miniSim.go = go
miniSim.run()

Cristian Oscar Viola