Resumen Técnico: HUNT (Navegación y Seguimiento de UAV de Alta Velocidad en Entornos No Estructurados mediante Marcos Relativos Instantáneos)

1. Planteamiento del Problema

Las operaciones de Búsqueda y Rescate (SAR) requieren que los Vehículos Aéreos No Tripulados (UAV) realicen dos tareas distintas pero críticas: atravesar entornos desconocidos y no estructurados a alta velocidad para localizar víctimas, y rastrear de manera fiable los objetivos detectados una vez identificados. Las soluciones de autonomía actuales enfrentan limitaciones significativas en condiciones de detección degradadas (por ejemplo, bosques densos, cañones urbanos, edificios colapsados) donde el GPS no está disponible y las características visuales son escasas o dinámicas.

• Limitaciones de la Navegación Global: Los enfoques tradicionales que dependen de GPS, Odometría Visual-Inercial (VIO) o SLAM se degradan rápidamente en estos entornos. Su dependencia de puntos de referencia persistentes y cierres de bucle (loop closures) conduce al error de deriva (drift) y a comportamientos inseguros a altas velocidades.
• Limitaciones de la Navegación Relativa: Los métodos centrados en objetos recientes rastrean con éxito los objetivos anclando el control a un objeto detectado. Sin embargo, estos métodos asumen que un objetivo es visible desde el inicio y permanece continuamente observable. Carecen de un mecanismo para la traversía segura a alta velocidad en terrenos desconocidos cuando no hay un objetivo en el campo de visión.

El desafío central abordado es lograr un marco unificado que permita la traversía segura a alta velocidad sin localización global y que transicione de forma fluida al seguimiento de objetivos sin revertir a una estimación de pose global frágil.

2. Metodología

El marco propuesto, HUNT, unifica la traversía, la adquisición y el seguimiento dentro de una única formulación relativa instantánea. Opera enteramente dentro de un marco de referencia relativo $R_t$ reconstruido en cada ciclo de control a partir de cantidades observables a bordo (actitud, altitud, velocidad instantánea y posición relativa del objetivo). Esto elimina la dependencia de estados no observables como la traslación horizontal o el yaw absoluto.

A. Regímenes de Operación

HUNT opera en dos modos, gestionados por un flujo unificado de percepción-control:

1. Modo de Merodeo (Búsqueda):

   • Contexto: No se detecta un objetivo con alta confianza.
   • Marco de Referencia: $R_t$ está anclado a la gravedad y al rumbo inicial, permaneciendo fijo en el tiempo.
   • Estimación de Estado: Un Filtro de Kalman Unscented (UKF) estima la posición relativa, la velocidad y la actitud. Aunque la posición horizontal presenta deriva debido a la falta de observación directa, la navegación sigue siendo robusta porque la generación de la referencia define los objetivos en relación con el estado estimado actual.
   • Generación de Referencia: El UAV regula la altitud, la velocidad de avance y el rumbo. El rumbo mantiene el yaw inicial, pero puede verse débilmente sesgado por detecciones de baja confianza para dirigirse hacia posibles objetivos sin activar un cambio de modo.
   • Navegación: El UAV atraviesa terreno con obstáculos definiendo trayectorias de referencia basadas en la estimación actual, asegurando que los objetivos de control sigan estando bien planteados a pesar de la deriva.

2. Modo de Seguimiento (Persecución):

   • Contexto: Se detecta un objetivo con alta confianza.
   • Marco de Referencia: $R_t$ se reancla en cada ciclo a la posición del objetivo detectado. Esto mantiene al objetivo estacionario en $R_t$, independientemente de la deriva global.
   • Estimación de Estado: El UKF actualiza el estado utilizando el desplazamiento relativo al objetivo derivado de la detección visual y la disparidad estéreo. La aceleración lineal no se utiliza en el modelo de proceso para evitar suposiciones sobre el movimiento del objetivo.
   • Generación de Referencia: El UAV mantiene una distancia de seguridad ($d_{xy}$) y un desfase vertical ($d_z$) mientras orienta el eje del cuerpo hacia el objetivo.

B. Arquitectura de Control

• Controlador Unificado: Ambos modos son ejecutados por un único Controlador Predictivo de Modelo No Lineal (NMPC).
• Restricciones de Seguridad: Funciones de Barrera de Control (CBF) de alto orden se integran directamente en el NMPC. Los obstáculos se identifican a partir de imágenes de profundidad estéreo, y un heurístico de tiempo de colisión selecciona los puntos de colisión más inminentes. Las CBF imponen una restricción de separación cuadrática, garantizando trayectorias libres de colisiones y dinámicamente factibles en tiempo real.
• Cambio de Modo: Una política de histéresis basada en la traza de la covarianza del estimador ($tr(P_t)$) gobierna las transiciones.
  • Merodeo $\to$ Seguimiento: Ocurre cuando la incertidumbre cae por debajo de un umbral ($\tau_\uparrow$).
  • Seguimiento $\to$ Merodeo: Ocurre cuando la incertidumbre supera un umbral superior ($\tau_\downarrow$).
  • Durante el merodeo, las detecciones de baja confianza sesgan el rumbo hacia el objetivo, facilitando una transición suave una vez que la confianza es suficiente.

3. Contribuciones Clave

• Formulación Relativa Instantánea Unificada: HUNT es el primer marco que integra la traversía a alta velocidad, la adquisición de objetivos y el seguimiento en entornos con obstáculos y sin GPS bajo una única formulación relativa, eliminando la dependencia de la pose global.
• Navegación Resiliente a la Deriva: Al anclar los objetivos a observables instantáneos en lugar de mapas globales, el sistema mantiene un vuelo seguro a alta velocidad incluso cuando las estimaciones de posición horizontal derivan significativamente.
• Transición de Modo Fluida: El marco permite el cambio reactivo entre la búsqueda (merodeo) y el seguimiento sin requerir la reinicialización de la pose global o el retorno a métodos de SLAM/VIO frágiles.
• Seguridad en Tiempo Real: La integración de CBF dentro del NMPC garantiza la evasión de colisiones en entornos no estructurados y dinámicos sin necesidad de mapas previos.

4. Resultados Experimentales

El marco fue validado en extensos experimentos en exteriores a través de diversos entornos: complejos de contenedores urbanos, configuraciones semiestructuradas y bosques densos.

• Desempeño de Merodeo:
  • En entornos urbanos, el UAV mantuvo un progreso constante hacia adelante a ~4.1 m/s con errores de rumbo limitados dentro de 2° respecto a la verdad de terreno de GPS.
  • En bosques densos (bajo el dosel), el UAV atravesó obstáculos con éxito a 2.0 m/s, manteniendo márgenes de separación >1.0 m. Los registros de GPS en estas condiciones mostraron errores horizontales de 2–6 m, lo que haría que la navegación basada en mapas fuera poco fiable, pero HUNT mantuvo un vuelo libre de deriva.
• Misiones SAR Completas:
  • Búsqueda Urbana: El UAV localizó los restos de un vehículo estacionario, cambiando de merodeo a seguimiento con errores de desplazamiento limitados dentro de ±0.5 m.
  • Persecución Urbana: El UAV rastreó un objetivo móvil (un maniquí en un ATV) a velocidades de hasta 11.4 m/s, manteniendo el error lateral dentro de un corredor de 1.2 m. Las detecciones de baja confianza sesgaron con éxito el rumbo de merodeo hacia el objetivo antes del cambio.
  • Búsqueda en Bosque: El UAV atravesó árboles densos a 2.0 m/s, cambió a seguimiento de un maniquí y mantuvo la persecución a pesar de severos reflejos y correcciones de rumbo de hasta 25°.
• Métricas Cuantitativas: En todas las misiones, HUNT logró un desempeño consistente de alta velocidad (velocidades medias de hasta 8.85 m/s) y navegación ágil (aceleraciones pico de hasta 31.11 m/s²) sin necesidad de reajuste de parámetros.

5. Significado y Reivindicaciones

El artículo afirma que HUNT representa un cambio fundamental en la autonomía para operaciones de SAR al demostrar que tanto la traversía como el seguimiento pueden expresarse sin pose global o mapeo.

• Robustez en Detección Degradada: El sistema logra una autonomía fiable en condiciones donde los métodos tradicionales de GPS, VIO y SLAM fallan debido a la deriva, la escasez de características o la oclusión.
• Capacidad Unificada: Cierra la brecha entre la "búsqueda" (atravesar terreno desconocido) y el "seguimiento" (seguir un objetivo), una capacidad previamente ausente en los marcos de navegación relativa.
• Seguridad y Agilidad: Al integrar CBF en el bucle de control, el marco garantiza la seguridad y la factibilidad dinámica a altas velocidades en entornos no estructurados.

Los autores señalan que, si bien la implementación actual utiliza un rumbo inicial fijo para el merodeo, el trabajo futuro podría incorporar razonamiento semántico (por ejemplo, reconocer puertas/ventanas) o memoria de corto plazo ligera para mejorar la eficiencia de la exploración y evitar el merodeo cíclico, todo ello manteniendo la formulación relativa instantánea.