Diferencia entre revisiones de «MecanumRob»

Revisión del 15:56 17 ago 2018

Contenido

1 Tareas pendientes
2 ROS
- 2.1 Servicio
3 Modelado
- 3.1 Modelo Cinemático Directo
- 3.2 Modelo Cinemático Inverso

Tareas pendientes

Calibración de la odometría.
Obtener las covarianzas de los sensores.
Filtro para la IMU y obtención de postura(comparar con el filtro Madgwick que viene por defecto con el nodo).
Filtro de Kalman.
Calibración de SLAM.
Fusión de los 2 sensores Hokuyo para el SLAM.
Sincronizar muestreo para el EFK.
Mux para los comandos de velocidad, de modo que se pueda elegir entre el control de play o el algoritmo de evasión (considerar yocs_cmd_vel_mux).
Migrar código de la base a C++.

ROS

El MecanumRob usa los siguientes paquetes de ROS:

mecanumrob_common: contiene las definiciones de menajes y servicios usados en los demás nodos, además de los .launch files, las reglas udev y el nodo para el control de play.
mecanumrob_roboclaw: el controlador de las motores, envía los comandos a los motores y publica la velocidad de las ruedas.
mecanumrob_model: el modelo cinemático del robot, tanto directo como inverso. Además el nodo que publica las transformaciones (próximamente el filtro de Kalman) y las pruebas para la odometría.
vfhp_local_planner: el módulo de evasión de obstáculos.
urg_node: controla un sensor Hokuyo.
phidgets_imu: controla la IMU.
gmapping: SLAM basado en las lecturas de los sensores láser.

Servicio

Para hacer que ROS corra automáticamente desde el arranque se usó el paquete robot_upstart. Lo que hace este paquete es crear un servicio del sistema operativo a partir de uno o mas .launch files. Si por alguna razón fuera necesario reiniciar el servicio (si por ejemplo algún nodo no responde) se puede usar el siguiente comando desde la terminal:

 $ sudo service mecanumrob stop
 $ sudo service mecanumrob start

Modelado

Primero es necesario definir el sistema de coordenadas del robot (local) y el estático (global).

Se define el marco de referencia local tal que el eje $X_R$ corresponde al frente del robot y el eje $Y_R$ corresponde al lado izquierdo. Además, se define la velocidad angular de las ruedas $\boldsymbol{\dot{\varphi}} = \begin{pmatrix} \dot{\varphi}_1 & \dot{\varphi}_2 & \dot{\varphi}_3 & \dot{\varphi}_4 \end{pmatrix}^T$ según la ley de la mano derecha tal que una rotación positiva se proyecta en dirección $Y_R$ positivo. Luego, se define el marco de referencia global con ejes $X_G$ , $Y_G$ . Para encontrar la posición del robot en este marco de referencia global al partir del movimiento de las ruedas se usa el modelo cinemático directo. Por otro lado, para determinar los comandos que se le deben enviar a los motores para alcanzar una cierta velocidad lineal o angular se usa el modelo cinemático inverso.

Modelo Cinemático Directo

El modelo cinemático directo nos permite obtener la velocidad del robot a partir de la velocidad de las ruedas. Definimos la velocidad respecto al marco de referencia local $\boldsymbol{\dot{u}}_R = \begin{pmatrix} \dot{x}_R & \dot{y}_R & \dot{\theta}_R \end{pmatrix}^T$ . Además queremos encontrar la velocidad respecto al marco de referencia global $\boldsymbol{\dot{u}}_G = \begin{pmatrix} \dot{x}_G & \dot{y}_G & \dot{\theta} \end{pmatrix}^T$ , para poder integrar y así obtener la posición. Para el robot mecanum se tiene que:

$\boldsymbol{\dot{u}}_R = \boldsymbol{J}\cdot\boldsymbol{\dot{\varphi}}$

$\begin{pmatrix} \dot{x}_R\\ \dot{y}_R\\ \dot{\theta}_R \end{pmatrix} = \boldsymbol{J} \begin{pmatrix} \dot{\varphi}_1\\ \dot{\varphi}_2\\ \dot{\varphi}_3\\ \dot{\varphi}_4 \end{pmatrix}$

con

$\boldsymbol{J} = \frac{r}{4}\begin{pmatrix} 1 & 1 & 1 & 1 \\ 1 & -1 & 1 & -1\\ \frac{1}{l_a + l_b} & -\frac{1}{l_a + l_b} & -\frac{1}{l_a + l_b} & \frac{1}{l_a + l_b} \end{pmatrix}$

Con esto obtenemos la velocidad lineal y angular del robot respecto al marco de referencia local. Luego, para obtener velocidades globales se debe multiplicar por la matriz de rotación $\boldsymbol{R}(\theta)$

$\boldsymbol{R}(\theta) = \begin{pmatrix} cos(\theta) & -sin(\theta) & 0 \\ sin(\theta) & cos(\theta) & 0 \\ 0 & 0 & 1 \end{pmatrix}$

Así, el modelo completo del movimiento del robot es:

$\boldsymbol{\dot{u}}_G = \boldsymbol{R}(\theta)\cdot\boldsymbol{J}\cdot\boldsymbol{\dot{\varphi}}$

$\begin{pmatrix} \dot{x}_G \\ \dot{y}_G \\ \dot{\theta} \end{pmatrix} = \frac{r}{4} \begin{pmatrix} cos(\theta) & -sin(\theta) & 0 \\ sin(\theta) & cos(\theta) & 0 \\ 0 & 0 & 1 \end{pmatrix}\begin{pmatrix} 1 & 1 & 1 & 1 \\ 1 & -1 & 1 & -1\\ \frac{1}{l_a + l_b} & -\frac{1}{l_a + l_b} & -\frac{1}{l_a + l_b} & \frac{1}{l_a + l_b} \end{pmatrix} \begin{pmatrix} \dot{\varphi}_1\\ \dot{\varphi}_2\\ \dot{\varphi}_3\\ \dot{\varphi}_4 \end{pmatrix}$

@@ Línea 4: / Línea 4: @@
 * Calibración de la odometría.
-* Watchdog timer para el nodo de la base
-* Migrar código de la base a C++.
 * Obtener las covarianzas de los sensores.
 * Filtro para la IMU y obtención de postura(comparar con el filtro [http://wiki.ros.org/imu_filter_madgwick Madgwick] que viene por defecto con el [https://github.com/ros-drivers/phidgets_drivers/tree/kinetic/phidgets_imu nodo]).
@@ Línea 11: / Línea 9: @@
 * Calibración de SLAM.
 * Fusión de los 2 sensores Hokuyo para el SLAM.
-* Sincronizar muestreo para el EFK
+* Sincronizar muestreo para el EFK.
 * Mux para los comandos de velocidad, de modo que se pueda elegir entre el control de play o el algoritmo de evasión (considerar [http://wiki.ros.org/yocs_cmd_vel_mux yocs_cmd_vel_mux]).
+* Migrar código de la base a C++.
 == ROS ==

Diferencia entre revisiones de «MecanumRob»

Revisión del 15:56 17 ago 2018

Contenido

Tareas pendientes

ROS

Servicio

Modelado

Modelo Cinemático Directo

Modelo Cinemático Inverso

Menú de navegación

Herramientas personales

Espacios de nombres

Variantes

Vistas

Más

Buscar

Navegación

Herramientas