domingo, 22 de febrero de 2015

2- Módulo de Visión de VisBot || Parte 1 (Cámaras)



En esta primera parte sobre el módulo de visión de VisBot trataremos sobre los primeros pasos en el desarrollo del módulo de visión del robot desde el Hardware utilizado para la captura de imágenes hasta la obtención de imágenes comprimidas capturadas dentro del sistema de ROS.

En primer lugar mencionar que la visión será estereoscópica y esta será proporcionada gracias a 2 cámaras "RaspberryPiCamera" cada una de ellas montada sobre una "RaspberryPi B+" a través del puerto MIPI CSI.
Cada una de las cámaras tiene las siguientes características destacadas:
Tamaño                          25 x 20 x 9 mm
Peso                               3 g
Sensor                            OmniVision OV5647
Resolución de sensor     2592 x 1944 pixels
Framerate Máximo        90 fps

En esta página se puede observar el resto de características de las cámaras: www.raspberrypi.org/documentation/hardware/camera.md

En ambas Raspberrys (las que controlan cada una de las cámaras) se ha instalado el mismo Software que consiste en un sistema operativo denominado "Raspbian" que es una adaptación de Debian preparada para la RaspberryPi, el Framework de ROS en su versión Indigo y dentro de este un nodo específicamente diseñado para controlar la "RaspberryPiCamera" denominado "raspicam_node".

Cada uno de los 2 submódulos de visión formados por " RaspberryPi B+" más
"RaspberryPiCamera" están posicionados a la misma altura pero diferente distancia horizontal entre si manteniendose tambien ambos sobre el mismo eje horizontal y estando sujetos de forma fija encajados en 2 bases de metacrilato con varias perforaciones para poder operar con el Hardware, entre ellas destacan las perforaciones destinadas a que las cámaras puedan captar imágenes del mundo real.

Para instalar "Raspbian" en las Raspberrys nos hemos basado en este tutorial: Instalación Raspbian.
Para instalar el Framework de ROS Indigo se realizó una compilación de dicho Framework desde su fuente como se explica en este tutorial: Instalar y compilar ROS desde fuente en Raspbian.
Una vez que esta operativo el Framework pasamos a la instalación desde fuente del paquete "raspicam" que contiene el "raspicam_node" la cual la realizamos dando los siguientes pasos dentro de la consola de comandos:

1- En primer lugar necesitaremos activar la cámara para que el sistema operativo la reconozca y podamos operar con ella (aclarar que esta operación no consiste en encender la cámara). Esto lo haremos dirigiéndonos a  la configuración de la Raspberry con el comando "sudo raspi-config" y navegando hasta la seccion "camera" donde tendremos que cambiar el estado a "enable".
2- Seguidamente instalamos algunos paquetes de ROS que necesitará el nodo "raspicam_node" para funcionar correctamente. El comando a ejecutar es el siguiente: "sudo apt-get install ros-indigo-image-transport ros-indigo-image-transport-plugins ros-indigo-image-transport-plugins ros-indigo-camera-info-manager"
3- Creamos un Catkin WorkSpace para trabajar con ROS mediante este tutorial: Tutorial para crear un Catkin WorkSpace.
4- Nos dirigimos al WorkSpace que hemos creado y nos introducimos dentro de la carpeta "src". Una vez dentro de esta carpeta descargamos en esta el código fuente del "raspicam_node" con esta instrucción: "git clone https://github.com/fpasteau/raspicam_node.git raspicam"
5- Volvemos al directorio raíz del WorkSpace y ejecutamos el comando de ROS destinado a realizar la compilación el cual realizará una compilación de todos los módulos que haya en el WorkSpace. La instrucción es esta: "catkin_make"

Una vez que hemos realizado los pasos anteriores el nodo "raspicam_node" ya estaría disponible para ser ejecutado utilizando la instrucción de ROS destinada a la ejecución de nodos. En este caso la instrucción de ejecución será esta: "rosrun raspicam raspicam_node".
Antes de continuar, dar unos apuntes sobre la estructura y funcionamiento del nodo:

- Publica sobre 2 Topics  "/camera/compressed" y "/camera/camera_info".
Por el Topic "/camera/compressed" se publican mensajes de tipo "sensor_msgs/CompressedImage" conteniendo cada uno de los cuales una imagen codificada en "jpeg" ademas de información adicional como el "time stamp" incluido dentro del "Header" del mensaje que es un dato que hace referencia al instante de tiempo en el que se toman las imágenes y que servirá para sincronizar las imágenes tomadas por 2 cámaras distintas. El "Header" mencionado antes es un tipo de dato predefinido de ROS que al utilizarlo dentro de una definición de tipo de mensaje dentro de este se recopilará información especial relativa al mensaje cuando este se cree y dicha información no es necesaria que la tengan todos los mensajes que se crean en el Framework de ROS pero es útil para los casos en los que es necesario transmitir dentro de un mensaje el "time stamp". El motivo por el que se utilizan imágenes comprimidas en "jpeg" es porque de esta forma se evita congestionar los Topics teniendo en cuenta por ejemplo que estos Topics pueden estar mandando los  mensajes en una Red local a través de Ethernet.
Por otro lado en el Topic "/camera/camera_info" se publican mensajes de tipo "sensor_msgs/CameraInfo". Por cada mensaje de tipo "sensor_msgs/CompressedImage"generado se creará un "sensor_msgs/CameraInfo" asociado que tendrá el mismo "time stamp" de la imagen a la que hace referencia. Estos mensajes de tipo "sensor_msgs/CameraInfo" además de contener el "Header" también contienen datos sobre la calibración de la cámara y la región real de la imagen que es capturada por el driver de la cámara, toda esta información se utiliza para que siempre que se requiera realizar algún tipo de procesamiento sobre una imagen se tenga también disponibles los parámetros de cámara asociados a la imagen así como la región de captura.

-Dispone de 3 servicios básicos:
"/camera/start_capture" cuya función es que la cámara empiece a grabar y se empiecen a publicar mensajes sobre los Topics mencionados anteriormente.
"/camera/stop_capture" detener la captura de imagen y la publicación de mensajes en los Topics.
"/set_camera_info" que sirve para almacenar de forma permanente dentro del paquete del nodo "raspicam_node" los parámetros de calibración de la cámara. Estos parámetros se almacenarán dentro del paquete "raspicam" en "/calibrations/camera.yaml"

-Tiene disponibles 5 parámetros configurables:
"width", ancho de las imágenes capturadas. Los valores de este parámetro tienen la siguiente restricción: 0 < width <= 1920
"height", altura de las imágenes capturadas. Los valores de este parámetro tienen la siguiente restricción: 0 < height <= 1080
“framerate”, frecuencia de captura de las imágenes y por lo tanto también frecuencia de emisión de mensajes por los Topics. Los valores de este parámetro tienen la siguiente restricción: 0 < framerate <= 90
“quality”, calidad de las imágenes capturadas. Los valores de este parámetro tienen la siguiente restricción: 0 < quality <= 100
“tf_prefix”, prefijo para el “frame_id”. El “frame_id” es otro de los atributos del tipo de dato “Header”.