WWW-POSIM v0.6.16Documentación del simulador
Menú de documentación
WWW-POSIM / Documentación del simulador

Planificación de rutas y control

El terreno verificado se convierte en una ruta comprobada y, después, en órdenes de propulsión. El movimiento medido por Gazebo alimenta la siguiente decisión.

La planificación personal de puntos submarinos usa los Límites de profundidad de misión. Un límite de simulación mayor conserva las comprobaciones de terreno y del espacio barrido por el casco descritas abajo.

Flujo de procesamiento

  1. 1. Objetivos, estado medido y terreno

    Convierte los destinos geográficos al marco local. Une las teselas numéricas confirmadas en una cuadrícula común; la cobertura ausente permanece desconocida.

  2. 2. Orientación geográfica y costera

    Calcula conexiones que evitan tierra y corredores de entrada a puerto. Evitar tierra en el mapa no basta para comprobar la profundidad.

  3. 3. Comprobar la huella barrida

    Amplía el casco con el margen de seguimiento. Recorta los triángulos del fondo contra cada cuadrado de consulta y obtiene el punto más alto; rechaza tierra, poca separación o datos ausentes. Un filtro de máximos acelera las zonas claramente profundas.

  4. 4. Segmento directo y desvío A*

    Prueba primero una recta comprobada. Si falla, busca en una retícula de ocho vecinos con coste de distancia y heurística euclídea. Respeta límites de esquinas, radio, longitud y tiempo.

  5. 5. Acortar y volver a comprobar

    Los atajos pasan la misma prueba de huella barrida y conservan los puntos protegidos de acceso al puerto. Devuelve los puntos y el margen mínimo, o un error si no encuentra una ruta válida.

  6. 6. Política de velocidad y propulsión

    El líder de la travesía frena ante curvas y error de rumbo, aplica una rampa de aceleración y control PI de velocidad, y gira con empuje diferencial. El seguidor mira hacia delante sobre la trayectoria medida del líder; inclinación y velocidad de acercamiento limitan las órdenes.

  7. 7. Realimentación y siguiente actualización

    Gazebo aplica fuerzas y devuelve el movimiento. Se supervisan avance, estabilidad y cobertura de terreno y sensores. El vehículo espera antes de entrar en cobertura sin verificar; nuevos objetivos o condiciones pueden exigir otra ruta.

Tras una recuperación prolongada sin avance, LIVE puede usar un corredor de aguas abiertas comprobado. Cuando vuelve a avanzar, intenta periódicamente regresar a la costa cartografiada y seguirla. Cada tramo requiere la aprobación de tierra cartografiada y profundidad numérica. La aproximación portuaria fija sigue siendo obligatoria y se alcanza por un corredor comprobado.

La travesía LIVE utiliza conexiones costeras cartográficas como guía temporal. Cuando la posición medida acerca la embarcación al objetivo de ruta al menos 50 m más que el último punto de referencia de la conexión, se libera esa guía y se vuelve a planificar la ruta siguiente. Cada nuevo corredor de propulsión requiere comprobar las exclusiones de tierra y la profundidad numérica.

Tras varios intentos de recuperación regional y diez minutos sin avance medido, LIVE puede buscar una conexión completa hacia la ruta en una ventana de terreno de 16 km. Sigue los giros elegidos en orden y comprueba cada tramo de propulsión con el terreno nativo actual y la tierra cartografiada.

Catálogo de planificación

Capa Método y alcance
Ruta geográfica Destinos, entradas a puertos, pasos y polígonos terrestres generan la orientación de larga distancia. La posición del catálogo de puertos y el punto de llegada navegable son distintos.
Campo de terreno Cuadrículas numéricas confirmadas en un marco común. Recorte exacto de triángulos para hallar el fondo más alto; cota superior con el filtro de máximos de SciPy. Los datos desconocidos o fuera del área siguen sin estar disponibles; el color satelital no se interpreta como profundidad.
Separación barrida Muestreo de segmentos cada 1 m como máximo, con media separación adicional en la huella. En un tramo que cambia de profundidad se usa el extremo más profundo. Es una envolvente conservadora, no una predicción completa del movimiento futuro en seis grados de libertad.
Búsqueda local Recta, después A* de ocho vecinos y comprobación conservadora de esquinas. Valores habituales: retícula de 4 m, radio de 600 m, ruta de 2 000 m y presupuesto de 25 s. El llamador puede elegir otros límites.
Márgenes del vehículo Superficie: radio de casco 3,5 m, margen de seguimiento inicial 4 m y separación del fondo 1,5 m. Submarino: 0,5 m, 2 m y 1 m, respectivamente. WAM-V personal puede reducir el margen de seguimiento a 2 m, manteniendo la profundidad mínima.
Resultado y vigilancia Puntos comprobados, margen elegido, información de cuadrícula/presupuesto y separación mínima representada. La vigilancia del corredor o de la cobertura puede detener la ejecución. Fallo de planificación, salida del corredor y ausencia de datos son estados diferentes.

Los márgenes se aplican al terreno representado; no certifican la precisión hidrográfica. Una ruta válida tampoco garantiza que el controlador la siga con las condiciones elegidas. Los marcadores AIS, una embarcación visible o un tema LiDAR disponible no establecen evasión de obstáculos móviles ni cumplimiento de COLREG: dependen del controlador del experimento.

Recuperación costera con terreno cargado en LIVE

La búsqueda usa el terreno numérico cargado y excluye la tierra cartografiada. La franja habitual de 1,5 km desde la costa limita la propia búsqueda. Si no ofrece continuidad comprobada, un desvío finito puede llegar a 2 km mar adentro y terminar de nuevo dentro de la franja habitual.

La ejecución nativa vuelve a comprobar cada tramo acotado. Los nuevos extremos evitan áreas de las que se salió recientemente. Un corredor completo y verificado puede cruzarlas y continuar más allá. Si el avance hacia el destino es inferior a 50 m, toda la ruta evita el área. Esta memoria de recuperación no cambia la prueba física de seguridad del casco.

Controladores y realimentación

Vía Entrada, implementación y salida Interpretación
ArduPilot personal Objetivos guiados o entrada manual → ArduRover/ArduSub SITL mediante MAVROS e interfaz JSON de Gazebo → canales de actuación. Influyen fuente de navegación, EKF, modo, armado y asignación de actuadores. Véase GNSS y navegación.
ROS 2 directo Nodo del usuario → temas permitidos y asignación de actuadores → fuerzas en Gazebo. El usuario aporta la ley de control. Publicar un objetivo o una velocidad no mide el movimiento obtenido.
Líder de la travesía Puntos comprobados → frenado en curvas, reducción por error de rumbo, rampa de aceleración, PI con integral limitada y empuje diferencial. Realimentación del movimiento corporal medido; periodo nominal 0,05 s. Perder el latido inhibe las órdenes.
Seguidor de la travesía Trayectoria medida del líder, separación y velocidad de acercamiento → anticipación, límites de velocidad/giro y frenado → propulsión. Separación nominal de 38 m entre orígenes de los cascos. Es un controlador demostrativo, no una prueba de seguridad de una flota.
Recuperación Una política explícita puede solicitar remolque físico limitado, conservando masa, contactos y arrastre. Registra este modo por separado. El remolque del líder se limita a 900 N y una velocidad solicitada de 0,8 m/s.

En las sesiones con GNSS configurado, las misiones vuelven a validar la ruta desde la posición medida después del armado y la estabilización de la navegación, antes de enviar el primer destino. La estabilización requiere una pose local reciente de la FCU y fusión GNSS válida o fusión de sensores externos aceptada. El estado GPS bruto del receptor se mantiene separado; véase GNSS y navegación.

Las misiones personales de WAM-V usan conformación de entrada de forma predeterminada (GUID_OPTIONS=0). Sin un rumbo explícito, actualizan el objetivo de posición original cada dos segundos de simulación fuera del radio de llegada de 0.75 m y solicitan velocidad y velocidad de guiñada nulas dentro de él. Un perfil guardado con el bit 64 activado conserva el planificador de puntos de paso con curvas S de ArduRover. BlueROV2 actualiza los objetivos cada dos segundos de simulación mediante el controlador de puntos de paso de ArduSub. La vigencia de la telemetría se mide con tiempo real; las comprobaciones de navegación y separación del terreno continúan durante el trayecto.

Cuando una embarcación a motor recibe un objetivo Guided vigente con velocidad y velocidad de guiñada nulas, el ArduRover incluido mantiene activo su PID de velocidad para contrarrestar la deriva hacia delante y hacia atrás. Este control regula la velocidad; la corrección hacia la posición definida comienza fuera de la zona de llegada. Los veleros, los objetivos caducados y los demás modos de control conservan su comportamiento de parada configurado.

Cuando el objetivo limitado por aceleración es cero, el controlador de velocidad borra su integral en la primera parada medida. Fuera de la banda de velocidad de parada configurada, también borra la integral retenida que aceleraría el barco en su dirección actual de deriva. Se conservan la integral de frenado opuesta y la compensación dentro de la banda de parada.

El perfil personal predeterminado usa WP_SPEED=0.5 m/s, ATC_STOP_SPEED=0.02 m/s y ATC_STR_RAT_I=0.

El complemento SITL interpola estados de sensores entre pasos físicos completados, con frecuencias objetivo de 200 Hz para Rover y 1000 Hz para Sub. Cambiar el intervalo físico cambia la cantidad de muestras intermedias. Cada intervalo termina en el estado físico y la marca temporal originales. La resolución física depende del paso de simulación física.

La demo pública WAM-V selecciona el modelado de entrada (GUID_OPTIONS=0) y actualiza el punto de paso original cada dos segundos simulados. Usa WP_RADIUS=0.2 m, LOIT_RADIUS=0.1 m y LOIT_SPEED_GAIN=1.0 para la aproximación y el mantenimiento de posición con oleaje. La llegada sigue exigiendo 0.75 m de precisión horizontal. Los espacios personales conservan sus parámetros seleccionados.

Restaurar un punto de control y desplazar el origen también cambia estados o coordenadas. El cambio de origen transforma terreno, ruta y trayectoria conservando las velocidades físicas; no debe derivarse como desplazamiento real. Conserva los eventos de recuperación, reinicio y cambio de origen al evaluar seguimiento o energía.

La pareja nativa líder/seguidor pertenece a LIVE. Las sesiones personales usan ArduPilot o ROS 2 según su configuración. WAM-V personal prueba inicialmente un radio de casco de 3,5 m más 4 m de seguimiento; si bloquea la salida o el paso, reintenta con 2 m de seguimiento sin reducir los 1,5 m de profundidad libre. Salir del corredor elegido detiene la misión.

Implementación y lecturas relacionadas

POSIM-Routing implementa navegación, planificación y conexiones costeras/portuarias. POSIM-Control contiene Pilot.cc y Follower.cc; sus políticas Python gestionan velocidad y estabilidad. WWW-POSIM coordina sesiones, selecciona el controlador y aplica las restricciones de misiones personales. Usa las revisiones seleccionadas por la aplicación.

Travesía mundial en directo · Controlar un espacio de trabajo local · Algoritmos de generación del terreno

Buscar en la documentación