Esta página se ha traducido mediante traducción automática. Haga clic aquí para ver la última versión en inglés.

Creador de mapas SLAM

Cree mapas de cuadrícula 2D utilizando SLAM basado en lidar

Descripción

La app SLAM Map Builder carga escaneos LIDAR registrados y datos de sensores de odometría para construir una cuadrícula de ocupación 2-D utilizando algoritmos de localización y mapeo simultáneos (SLAM). La coincidencia de escaneo incremental alinea y superpone escaneos para construir el mapa. La detección de cierre de bucle se ajusta a la deriva de la odometría del vehículo detectando ubicaciones visitadas previamente y ajustando el mapa general. A veces, el algoritmo de coincidencia de escaneo y la detección de cierre de bucle requieren un ajuste manual. Utilice la app para alinear manualmente los escaneos y modificar los cierres de bucles para mejorar la precisión general del mapa. También puede ajustar la configuración del algoritmo SLAM para mejorar la creación automática de mapas.

Para usar la app:

Import	Para cargar archivos de registro de rosbag, seleccione Import > Import from rosbag. Seleccione el archivo rosbag y haga clic en Open. Esto abre la pestaña Import. Para obtener más información, consulte Importar y filtrar un rosbag. Para cargar datos desde el espacio de trabajo, Import > Import from workspace. Seleccione las variables Scans y Poses utilizando los menús desplegables provistos. También puede especificar las variables en la función slamMapBuilder. Consulte Uso programático.
SLAM Settings	Utilice SLAM Settings para ajustar la configuración del algoritmo SLAM. Se proporcionan valores predeterminados, pero sus sensores y datos específicos pueden requerir un ajuste de estas configuraciones. El valor más importante a ajustar es Loop Closure Threshold. Para obtener más información, consulte Ajustar la configuración de SLAM.
Build	Haga clic en Build para comenzar el proceso de construcción del mapa SLAM. El proceso de construcción alinea los escaneos en el mapa mediante coincidencias de escaneo incrementales, identifica cierres de bucles al visitar ubicaciones anteriores y ajusta las poses. Haga clic en Pause en cualquier momento durante el proceso de creación del mapa para alinear manualmente los escaneos incrementales o modificar los cierres de bucle.
Incremental Match Loop Closure	Haga clic en Incremental Match para modificar la pose relativa del marco seleccionado actualmente y alinear el escaneo con el escaneo anterior. Haga clic en Loop Closure para modificar o ignorar el cierre de bucle detectado para el cuadro actual. Utilice el control deslizante en la parte inferior para retroceder a áreas donde la coincidencia de escaneos o los cierres de bucles no son precisos. Puede modificar cualquier número de escaneos o cierres de bucle. Para obtener más información, consulte Modificar escaneos de incremento y cierres de bucle.
Sync	Después de modificar su mapa, haga clic en Sync para actualizar todas las poses en el mapa escaneado. Las dos opciones bajo Sync son Sync, que busca nuevos cierres de bucle, o Sync Fast, que omite la búsqueda de cierres de bucle y solo actualiza el mapa de escaneo. Para obtener más información, consulte Sincronizar el mapa.
Export to Occupancy Grid	Cuando esté satisfecho con el aspecto del mapa, haga clic en Export to Occupancy Grid para exportar el mapa a un archivo m o guardarlo en el espacio de trabajo. El mapa se genera como una cuadrícula de ocupación probabilística 2-D en un objeto occupancyMap.
Open Session Save Session	Puedes abrir sesiones de app existentes que hayas guardado usando Open Session. Cuando esté en la pestaña Map Builder, puede guardar su progreso en un archivo m usando Save Session.

Abrir la aplicación Creador de mapas SLAM

• MATLAB^® Tira de herramientas: En la pestaña Apps, en ROBOTICS AND AUTONOMOUS SYSTEMS, haga clic en SLAM Map Builder.

• Ventana de comandos MATLAB: Ingresa slamMapBuilder

Ejemplos

Construya y ajuste mapas usando escaneos Lidar con SLAM

La app SLAM Map Builder le ayuda a construir una cuadrícula de ocupación a partir de escaneos LiDAR utilizando algoritmos de localización y mapeo simultáneos (SLAM). El mapa se construye estimando poses mediante la comparación de escaneos y usando cierres de bucle para optimizar el gráfico de poses. Este ejemplo le muestra el flujo de trabajo para cargar un rosbag de datos de escaneo LIDAR, filtrar los datos y crear el mapa. Ajuste el mapa de escaneo ajustando las coincidencias de escaneo incrementales y modificando los cierres de bucle.

Cargar datos de escaneo Lidar

Cargue el archivo MAT de ejemplo en el espacio de trabajo, que contiene una variable, scans, como un arreglo de celdas de objetos lidarScan.

load slamLidarScans.mat

Abre la app

En la pestaña Aplicaciones, en ROBÓTICA Y SISTEMAS AUTÓNOMOS, haga clic en Generador de mapas SLAM.

También puedes llamar a la función slamMapBuilder:

slamMapBuilder

Importar escaneos Lidar

Haga clic en Importar > Importar desde el espacio de trabajo para cargar los escaneos. Los datos almacenados como rosbag se pueden cargar con una licencia de ROS Toolbox .

Seleccione la variable scans en el menú desplegable Escaneos.

En la barra de herramientas, establezca Disminuir resolución (%) en 10. Reducir la resolución de los datos de manera uniforme para reducir el tiempo de cálculo del algoritmo SLAM. Para este ejemplo, el 10% es cada cinco escaneos. Haga clic en Aplicar.

Utilice el control deslizante o las teclas de flecha en la parte inferior para obtener una vista previa de los escaneos.

Una vez que haya terminado de importar, haga clic en Cerrar.

Ajustar la configuración de SLAM

El algoritmo SLAM se puede ajustar mediante el cuadro de diálogo Configuración SLAM. Los parámetros deben ajustarse según las especificaciones de su sensor, el entorno y su aplicación. Para este ejemplo, aumente el Umbral de cierre de bucle de 200 a 300. Este umbral aumentado disminuye la probabilidad de aceptar y utilizar un cierre de bucle detectado. Establezca el Intervalo de optimización en 10. Con cada décimo cierre de bucle aceptado, el gráfico de pose se optimiza para tener en cuenta la deriva.

Construye el mapa

Después de filtrar sus datos y configurar los ajustes del algoritmo SLAM, haga clic en Construir. La app comienza a procesar escaneos para crear el mapa. Debería ver cómo el control deslizante avanza y los escaneos se superponen en el mapa. La trayectoria estimada del robot se traza en el mismo mapa de escaneo. Las coincidencias de escaneo incremental se muestran en el panel Coincidencia incremental. Cada vez que se detecta un cierre de bucle, el panel Cierre de bucle muestra los dos escaneos superpuestos uno sobre el otro.

Ajustar coincidencias de escaneo o cierres de bucle

En cualquier momento durante el proceso de construcción, si nota que el mapa está distorsionado o que una coincidencia incremental o un cierre de bucle se ven extraños, haga clic en Pausa para seleccionar escaneos para ajustar. También puede modificar los escaneos al final del proceso de compilación. Navegue usando las teclas de flecha o el control deslizante hasta el punto del archivo donde ocurre la distorsión por primera vez. Haga clic en los botones Coincidencia incremental o Cierre de bucle para ajustar las poses de escaneo que se muestran actualmente. En esta sección, el mal cierre del bucle es artificial y sólo tiene fines ilustrativos.

Haga clic en el botón Cierre de bucle. Esto abre una pestaña para modificar la pose relativa del cierre del bucle.

Para ignorar por completo el cierre del bucle, haga clic en Ignorar. De lo contrario, modifique manualmente la pose relativa del escaneo hasta que los escaneos se alineen.

Haga clic en Pan Scan o Rotate Scan, luego haga clic y arrastre en la figura para alinear los dos escaneos. Haga clic en Aceptar cuando haya terminado. Puede hacer esto para múltiples escaneos.

Después de modificar las poses de escaneo para coincidencias incrementales y cierres de bucle, haga clic en Sincronizar para aplicar los cambios. SyncFast actualiza el mapa sin buscar nuevos cierres de bucle y reduce el tiempo de cálculo si ya ha procesado todos los escaneos.

Exportar cuadrícula de ocupación

Una vez que haya sincronizado sus cambios y haya terminado de construir el mapa, debería ver un mapa escaneado completamente superpuesto con la trayectoria del robot.

Haga clic en Exportar Cuadrícula de ocupación para obtener un mapa de ocupación final de su entorno como un objeto occupancyMap. Exporte el mapa al espacio de trabajo o a un archivo MAT. Puede crear un mapa a partir de un subconjunto de escaneos desplazándose hacia atrás hasta el marco deseado antes de exportar y seleccionando Hasta el escaneo seleccionado actualmente.

Mostrar el mapa de ocupación almacenado.

load("slamMapBuilderOccMap.mat")
show(myOccMap)
title("Built Occupancy Map")

También puedes guardar una sesión de la app SLAM Map Builder usando el botón Guardar sesión. La app escribe el estado actual de la app en un archivo .mat que se puede cargar más tarde usando Abrir sesión.

Ejemplos relacionados

• Implementar localización y mapeo simultáneos (SLAM) con escaneos Lidar

Parámetros

Scans — Escaneos lidar para importar desde el espacio de trabajo

Arreglo de celdas de N elementos de objetos lidarScan

Escaneos Lidar para importar desde el espacio de trabajo, especificados como un arreglo de celdas de N elementos de objetos lidarScan.

Poses (Odometry) — Poses para importar desde el espacio de trabajo

matriz de N por 3 | Arreglo de celdas de N elementos con vectores fila de tres elementos

Plantea importar desde el espacio de trabajo, especificado como una matriz de N por 3 o un arreglo de celdas de N elementos de vectores fila de tres elementos. Cada fila de la matriz de N por 3 y cada vector fila de tres elementos del arreglo de celdas representan una pose con la forma [x y theta]. x y y comprenden la posición en metros y theta es la orientación en radianes.

Ejemplo: [0 0 0; 1 1 pi/4; 2 2 pi/2]

Ejemplo: {[0 0 0],[1 1 pi/4],[2 2 pi/2]}

Uso programático

slamMapBuilder(bag)

slamMapBuilder(bag) abre la app SLAM Map Builder e importa el archivo de registro de rosbag especificado en bag, un objeto BagSelection creado usando la función rosbag (ROS Toolbox). La app se abre en la pestaña Import para filtrar los datos del sensor en su rosbag.

slamMapBuilder(sessionFile)

slamMapBuilder(sessionFile) abre la app SLAM Map Builder desde un archivo de sesión guardado llamado sessionFile. Un archivo de sesión de app se crea a través del botón Save Session en la barra de herramientas de la app .

slamMapBuilder(scans)

slamMapBuilder(scans) abre la app SLAM Map Builder e importa los escaneos especificados en scans, un arreglo de celdas de objetos lidarScan. La app asume que ha filtrado previamente sus escaneos y omite el proceso de importación. Haga clic en Build para comenzar a construir el mapa.

slamMapBuilder(scans,poses)

slamMapBuilder(scans,poses) abre la app SLAM Map Builder e importa los escaneos y poses. scans se especifica como un arreglo de celdas de objetos lidarScan. poses es una matriz de vectores [x y theta] que corresponden a las poses de scans. La app asume que ha filtrado previamente sus escaneos y omite el proceso de importación. Haga clic en Build para comenzar a construir el mapa.

Más acerca de

Importar y filtrar un rosbag

Al hacer clic en el botón Import, especifique los parámetros para su rosbag y cómo desea filtrar los datos en la barra de herramientas. Debes Apply tu configuración para ver los escaneos actualizados en las figuras.

• Seleccione el tema ROS para los escaneos lidar y la odometría (si está disponible).

• En Odom Topic, si selecciona Use TF, especifique el marco del sensor de escaneo LiDAR , Lidar Frame, y el marco fijo base del vehículo, Fixed Frame. Los elementos del menú desplegable se generan en función de los cuadros disponibles en el árbol de transformación tf del rosbag. La app solo admite los temas /tf y /tf2.

• Especifique Start Time y End Time si desea recortar datos de rosbag. Puede utilizar los controles deslizantes o escribir manualmente los valores de tiempo.

• Seleccione el porcentaje de reducción de resolución deseado de los escaneos en Downsample to (%) . Esto reduce uniformemente la muestra de los escaneos según el porcentaje. Por ejemplo, un valor del 25 % solo seleccionaría una de cada cuatro exploraciones.

• Haga clic en Apply para ver los nuevos escaneos filtrados y aplicar todas las configuraciones. Close la pestaña cuando hayas terminado.

Si desea tener más control sobre el filtrado de escaneos en el rosbag, importe su rosbag a MATLAB usando rosbag (ROS Toolbox). Filtra el rosbag usando select (ROS Toolbox). Para abrir la app usando su rosbag filtrado personalizado, consulte Uso programático.

Ajustar la configuración de SLAM

Para mejorar el proceso de creación automática de mapas, el algoritmo SLAM tiene parámetros ajustables. Haga clic en SLAM Settings para ajustar los parámetros. Utilice Lidar SLAM Parameters para afectar diferentes aspectos de los procesos de alineación de escaneo y detección de cierre de bucle. Además, ajuste NLP Solver Parameters para cambiar la forma en que el algoritmo de optimización del mapa mejora el mapa general en función de los cierres de bucle.

Lidar SLAM Parameters:

• Map Resolution (cells/m) –– Resolución del mapa. La resolución afecta la precisión de la ubicación de la alineación del escaneo y define el tamaño de salida de la cuadrícula de ocupación.

• Lidar Range [min,max] (m) –– Rango de lecturas del sensor LiDAR . Al procesar los escaneos LIDAR, se ignoran las lecturas fuera del rango LIDAR.

• Loop Closure Threshold –– Umbral sin unidad para aceptar cierres de bucle. Dependiendo de sus escaneos LIDAR, la puntuación promedio de cierre de bucle varía. Si el proceso de construcción no encuentra cierres de bucle y el vehículo vuelve a visitar ubicaciones en el mapa, considere reducir este umbral.

• Loop Closure Search Radius (m) –– Radio para buscar cierres de bucle. Según la pose de odometría, el algoritmo busca cierres de bucles en el mapa existente dentro del radio dado en metros.

• Loop Closure Max Attempts –– Número de intentos de encontrar cierres de bucle. Cuando este número aumenta, el algoritmo intenta más encontrar cierres de bucles en el mapa, pero aumenta el tiempo de cálculo.

• Loop Closure Auto Rollback –– Permitir el rechazo automático de cierres de bucle. El algoritmo rastrea el error residual de la optimización del mapa. Si detecta un cambio repentino en el error y este parámetro está establecido en on, se rechaza el cierre del bucle.

• Optimization Interval (# of Loop Closures) –– Número de cierres de bucle detectados aceptados para activar la optimización. De forma predeterminada, el mapa se optimiza con cada cierre de bucle encontrado.

• Movement Threshold [Linear,Angular] (m,rad) –– Cambio mínimo en la pose requerido para aceptar un nuevo escaneo. Si la pose del vehículo no supera este umbral, el siguiente escaneo se descarta del proceso de creación del mapa.

NLP Solver Parameters:

• Max Iterations –– Número máximo de iteraciones para la optimización del mapa. Aumentar este valor puede mejorar la precisión del mapa, pero aumenta el tiempo de cálculo.

• Max Time (s) –– Tiempo máximo permitido para la optimización del mapa especificado en segundos. Aumentar este valor puede mejorar la precisión del mapa, pero aumenta el tiempo de cálculo.

• Gradient Tolerance –– Límite inferior de la norma del gradiente de la función de costo para optimización. Reducir este valor hace que la optimización se ejecute durante más tiempo para buscar un mínimo local, pero aumenta el tiempo de cálculo.

• Function Tolerance –– Límite inferior del cambio en la función de costo para optimización. Reducir este valor hace que la optimización se ejecute durante más tiempo para buscar un mínimo local, pero aumenta el tiempo de cálculo.

• Step Tolerance –– Límite inferior del tamaño del paso para la optimización. Reducir este valor hace que la optimización se ejecute durante más tiempo para buscar un mínimo local, pero aumenta el tiempo de cálculo.

• First Node Pose [x,y,theta] (m,rad) –– Pose del primer nodo del grafo. Si necesita desplazar la posición de los escaneos en el mapa, especifique la posición, [x y], en metros y la orientación, theta, en radianes.

Después de cambiar cualquiera de estas configuraciones, se debe reiniciar el proceso de creación del mapa para reconstruir el mapa con los nuevos parámetros.

Modificar coincidencias incrementales y cierres de bucles

Esta app le permite modificar manualmente los escaneos incrementales y ajustar los cierres de bucle detectados. Si observa que los escaneos no están alineados correctamente después de construir el mapa, use los botones Incremental Match y Loop Closure para abrir sus pestañas de modificación. Utilice los botones de la barra de herramientas de modificación para ajustar la pose relativa entre escaneos.

• Ignore –– Al modificar los cierres de bucle, puedes simplemente ignorar los cierres de bucle si son inexactos. El algoritmo siempre descarta el cierre de bucle ignorado si se detecta en la misma sesión de la app. No puede ignorar las coincidencias de escaneo incremental.

• Pan Scan –– Haga clic en este botón para cambiar la pose manualmente. Después de seleccionar, haga clic y arrastre dentro del mapa para cambiar los escaneos y superponerlos correctamente. Alinee todos los puntos de los escaneos hasta que esté satisfecho. También puede especificar manualmente la ubicación X, Y en la sección Relative Pose.

• Rotate Scan –– Haga clic en este botón para rotar la pose manualmente. Después de seleccionar, haga clic y arrastre dentro del mapa para rotar los escaneos y superponerlos correctamente. Alinee todos los puntos de los escaneos hasta que esté satisfecho. También puede especificar manualmente la ubicación Theta en la sección Relative Pose.

Sincronizar el mapa

Después de realizar modificaciones en el proceso de creación de mapas utilizando Incremental Scans y Loop Closures, debes sincronizar el mapa para aplicar los cambios. Según los cambios que realice para alinear correctamente los escaneos, el mapa general cambia y las alineaciones cambian para cada escaneo después de su modificación. Tienes dos opciones después de realizar tus modificaciones, Sync o Sync Fast. Si hace clic en Sync Fast, los cambios en las poses se aplican automáticamente y no se producen otros cambios en el mapa. Sync reinicia todo el proceso de creación de mapas y detección de cierre de bucle a partir de la primera modificación. Se aplican las modificaciones especificadas, pero el algoritmo intenta realinear otros escaneos y buscar también nuevos cierres de bucle.

Historial de versiones

Introducido en R2019b

Consulte también

Funciones

• buildMap | matchScans | matchScansGrid | rosbag (ROS Toolbox) | optimizePoseGraph

Objetos

• lidarSLAM | lidarScan | occupancyMap | poseGraph | factorGraph