Diferencia entre revisiones de «Butialo: Ejemplo 8 - Seguidor de líneas con obstáculos, sin eventos, utilizando un sensor de grises y uno de distancia»

De Proyecto Butiá
Saltar a: navegación, buscar
(→‎Solución)
(→‎Solución)
Línea 24: Línea 24:
 
while true do
 
while true do
 
     avanzar()
 
     avanzar()
−
     while (puedo_avanzar()) do
+
     while (es_negro() and not hay_obstaculo()) do
 
util.wait(INTERVALO_CHEQUEO)
 
util.wait(INTERVALO_CHEQUEO)
 
     end
 
     end
−
     retroceder_aleatorio()
+
     if hay_obstaculo() then
−
     girar_aleatorio()
+
esquivar_obstaculo()
 +
     else
 +
buscar_negro()
 +
util.wait(TIEMPO_CENTRADO)
 +
invertir_sentido()
 +
    end
 
end
 
end
 
</syntaxhighlight>
 
</syntaxhighlight>
  
−
* '''avanzar'''
+
* '''invertir_sentido'''
−
Activa los motores haciendo que los mismos giren a una velocidad prefijada en la constante MOTOR_VEL.
+
Cambia el sentido de izquierda a derecha o viceversa.
  
 
<syntaxhighlight lang="lua">
 
<syntaxhighlight lang="lua">
−
local function avanzar()
+
local function invertir_sentido()
−
     Motors.setvel2mtr(0, MOTOR_VEL, 0, MOTOR_VEL)
+
     if sentido == "I" then
 +
sentido = "D"
 +
    else
 +
sentido = "I"
 +
    end
 
end
 
end
 
</syntaxhighlight>
 
</syntaxhighlight>
  
−
* '''puedo_avanzar'''
+
* '''avanzar'''
−
Retorna un valor booleano que indica si el robot se encuentra en peligro de caerse, según el valor obtenido por el sensor de grises y su comparación con la variable COLOR_MESA.
+
Activa los motores haciendo que los mismos giren a una velocidad prefijada en la constante MOTOR_VEL.
  
 
<syntaxhighlight lang="lua">
 
<syntaxhighlight lang="lua">
−
local function puedo_avanzar()
+
local function avanzar()
−
     return (Grey_2.getValue() < COLOR_MESA)
+
     Motors.setvel2mtr(0, MOTOR_VEL, 0, MOTOR_VEL)
−
end</syntaxhighlight>
+
−
 
+
−
* '''chequear_giro_izquierda'''
+
−
Retorna un valor booleano que indica si el robot debe girar hacia la izquierda. Para girar de forma aleatoria, a izquierda o derecha, obtenemos un valor entre 0 y 1 con la función random de la bibloteca math. Si el valor randómico obtenido es mayor a 0.5 definimos que el giro será hacia la izquierda, retornando True y en caso contrario deberá girar a la derecha retornando False.
+
−
 
+
−
<syntaxhighlight lang="lua">
+
−
local function chequear_giro_izquierda()
+
−
    local sentido = math.random (0, 1)
+
−
    return sentido > 0.5
+
 
end
 
end
 
</syntaxhighlight>
 
</syntaxhighlight>
  
−
* '''girar_aleatorio'''
+
* '''retroceder'''
−
Nuevamente utilizamos la función random para obtener un número aleatorio entre MIN_TIEMPO_GIRO y MAX_TIEMPO_GIRO y así definir el tiempo durante el cual el robot estará girando. Luego chequeamos con la función chequear_giro_izquierda() si el giro será en sentido izquierdo o derecho, dependiendo de ese valor se procederá entonces a girar en ese sentido con una velocidad definida por la variable VELOCIDAD_GIRO.
+
Retrocede el Butiá haciendo que los motores giren a una velocidad prefijada en la constante MOTOR_VEL.
  
 
<syntaxhighlight lang="lua">
 
<syntaxhighlight lang="lua">
−
local function girar_aleatorio()
+
local function retroceder()
−
     local tiempo_giro = math.random(MIN_TIEMPO_GIRO, MAX_TIEMPO_GIRO)
+
     Motors.setvel2mtr(1, MOTOR_VEL, 1, MOTOR_VEL)
−
    local izquierda = chequear_giro_izquierda()
+
−
    if (izquierda) then
+
−
Motors.setvel2mtr(0, VELOCIDAD_GIRO, 1, VELOCIDAD_GIRO)
+
−
    else
+
−
Motors.setvel2mtr(1, VELOCIDAD_GIRO, 0, VELOCIDAD_GIRO)
+
−
    end
+
−
    util.wait(tiempo_giro)
+
 
end
 
end
 
</syntaxhighlight>
 
</syntaxhighlight>

Revisión del 21:52 10 oct 2012

Descripción

Se desea implementar un seguidor de líneas de nivel avanzado que permita al robot Butiá seguir el rastro de una línea de color negro sobre el suelo eludiendo obstáculos.

El robot deberá avanzar mientras se encuentre en una zona oscura y no detecte la proximidad de un obstáculo. En caso de salirse de la línea, deberá girar para poder encontrar nuevamente una zona oscura y en caso de detectar un obstáculo procederá a aplicar una técnica de rodeo poder continuar avanzando por la línea de color negro.

Solución

Descripción

Obtenemos el valor de la variable COLOR_NEGRO de la misma forma que lo hicimos en el Ejemplo 1. Además, debemos calibrar el valor de la distancia mínima a partir de la cual el robot detecta la presentacia de un obstáculo y por lo tanto deberá esquivar el mismo utilizando una técnica de rodeo.

El robot deberá seguir el rastro de la línea de color negro de la misma forma que se realizó en el Ejemplo 1, chequeando además la presencia de un obstáculo que deberá esquivar para luego regresar a línea negra.

Una vez calibrados los valores de los sensores, se organiza la estructura de la solución en diferentes funciones de forma de modularizar y distinguir fácilmente las acciones. El programa principal quedaría de la siguiente forma:

  • programa principal

Consiste en avanzar el robot hasta tanto no se encuentre en peligro de caer de la mesa, en caso contrario deberá retroceder de forma aleatoria. Luego de que se retrocede aleatoriamente, por un tiempo determinado, se utiliza la función girar_aleatorio() para que la siguiente vez que se avance, se haga en un sentido aleatorio. 

while true do
    avanzar()
    while (es_negro() and not hay_obstaculo()) do
	util.wait(INTERVALO_CHEQUEO)
    end
    if hay_obstaculo() then
	esquivar_obstaculo()
    else
	buscar_negro()
	util.wait(TIEMPO_CENTRADO)
	invertir_sentido()
    end
end
  • invertir_sentido

Cambia el sentido de izquierda a derecha o viceversa. 

local function invertir_sentido()
    if sentido == "I" then
	sentido = "D"
    else
	sentido = "I"
    end
end
  • avanzar

Activa los motores haciendo que los mismos giren a una velocidad prefijada en la constante MOTOR_VEL. 

local function avanzar()
    Motors.setvel2mtr(0, MOTOR_VEL, 0, MOTOR_VEL)
end
  • retroceder

Retrocede el Butiá haciendo que los motores giren a una velocidad prefijada en la constante MOTOR_VEL. 

local function retroceder()
    Motors.setvel2mtr(1, MOTOR_VEL, 1, MOTOR_VEL)
end

Configuración

Se debe colocar un sensor de escala de grises lo más cercano a la mesa, pero siempre sin tocarla, en la parte de adelante del Butiá.

En nuestro caso encastramos piezas de forma de generar el soporte para adherir el sensor al Butiá, quedando dicho sensor a ras de la mesa.

Se muestra a continuación una imagen ilustrativa de la configuración del robot vista desde arriba.

Configuración

Video

Código

Butialo: Ejemplo 3 - Seguidor de líneas con obstáculos, sin eventos, utilizando un sensor de grises y uno de distancia - Código

Obtenido de «http://www.fing.edu.uy/inco/proyectos/butia/mediawiki/index.php?title=Butialo:_Ejemplo_8_-_Seguidor_de_líneas_con_obstáculos,_sin_eventos,_utilizando_un_sensor_de_grises_y_uno_de_distancia&oldid=3257»