Recorrer mapa

Ahora intentamos que el robot recorra todos los puntos del mapa comenzando desde un punto dado, usando solamente odometría para localizarse. En el ejemplo podemos ver como recorre todos los puntos partiendo del punto cero. Podemos observar que se desvia mucho usando solamente la odometría ya que no puede corregir su posición.

El robot empieza en el punto 0, avanza al punto 1, luego al 3, y ahora como tiene que ir al 2 y existe una pared entre medias, debe recorrer los puntos 1 y 0 antes, y finalmente termina en el 4 y regresa al punto inicial 0.

Histogramas

Tomamos diez lecturas en cinco puntos distintos dentro del laberinto y guardamos cada una de las firmas en un fichero.

Cuando colocamos el robot en el laberinto vuelve a tomar las diez lecturas y las compara con las cinco firmas almacenadas, primero mediante frecuencia de aparición y después la medida en cada ángulo. La comparación que tenga menos diferencia es la posición y orientación estimada.

Este es el mapa de los cinco puntos.

En este ejemplo ponemos el robot en el punto cuatro y comprobamos que reconoce su posición y orientación aproximada.

Radar

Tomamos cinco lecturas a una velocidad de 30 y amplitud de 90º. Primero coloca el sensor de ultrasonidos a 45º, gira 90º y se recoloca en la posición inicial restando 45º.

Cuando el ángulo es mayor de 180º  rotamos el robot en vez del sensor de ultrasonidos.

En  este ejemplo rotamos 270º a velocidad 100, tomando 5 lecturas. Los giros son exactamente igual que en el caso anterior.

Visualización

En la primera imagen vemos el mapa y las partículas escalado a 1/3.

En esta imagen vemos el mapa con las partículas ajustado a la pantalla del robot. (La coordenada x escalada a 1/2 y la y a 1/3)

Este es el laberinto real.