POSIM v1.0.1Platform for Ocean Simulation · Documentación
Menú de documentación
POSIM / Referencia de plugins

Posicionamiento USBL

El posicionamiento acústico de base ultracorta (USBL) localiza equipos bajo el agua. Este ejemplo conecta un transceptor con dos transpondedores. Puedes consultar todos o seleccionar uno por ID.

Iniciar el mundo de ejemplo

En la terminal A preparada para tu instalación:

ros2 launch posim_demos posim_world.launch.py \
  world_name:=usbl_tutorial headless:=false
Ejemplo USBL: un transceptor y dos transpondedores.
Ejemplo USBL: un transceptor y dos transpondedores.

El mundo ya contiene los tres dispositivos. En la terminal B preparada, recibe sus posiciones:

ros2 topic echo /USBL/transceiver_manufacturer_168/transponder_location \
  posim_interfaces/msg/Location --once
ros2 topic echo /USBL/transceiver_manufacturer_168/transponder_location_cartesian \
  posim_interfaces/msg/Location --once

Ambos mensajes incluyen transponder_id, pero sus campos tienen significados distintos:

Salida x y z
transponder_location Ángulo horizontal, grados Distancia, m Elevación, grados
transponder_location_cartesian x relativa, m y relativa, m z relativa, m

Se usa la diferencia entre las posiciones en el sistema de coordenadas del mundo. El ángulo horizontal vale 0° hacia +x y 90° hacia +y; la elevación positiva apunta a +z. Ten en cuenta estos ejes al combinar datos en la referencia del vehículo.

Integración SDF

Coloca el transceptor dentro del modelo box. Cada ID corresponde al modelo situado en la misma posición de la lista transponder_attached_object:

<plugin filename="UsblTransceiver" name="posim_gz_sensor_plugins::UsblTransceiver">
  <namespace>USBL</namespace>
  <transceiver_device>transceiver_manufacturer</transceiver_device>
  <transceiver_ID>168</transceiver_ID>
  <transponder_device>transponder_manufacturer</transponder_device>
  <transponder_ID>1,2</transponder_ID>
  <transponder_attached_object>sphere,sphere2</transponder_attached_object>
  <sound_speed>1540</sound_speed>
  <enable_ping_scheduler>true</enable_ping_scheduler>
  <ping_frequency>0.5</ping_frequency>
  <interrogation_mode>common</interrogation_mode>
</plugin>

Coloca este transpondedor en sphere y otro en sphere2 con transponder_ID igual a 2. Nombre, ID y namespace del transceptor deben coincidir en ambos extremos:

<plugin filename="UsblTransponder" name="posim_gz_sensor_plugins::UsblTransponder">
  <namespace>USBL</namespace>
  <transceiver_device>transceiver_manufacturer</transceiver_device>
  <transceiver_ID>168</transceiver_ID>
  <transceiver_model>box</transceiver_model>
  <transponder_device>transponder_manufacturer</transponder_device>
  <transponder_ID>1</transponder_ID>
  <sound_speed>1540</sound_speed>
  <mu>0</mu>
  <sigma>0</sigma>
</plugin>

Parámetros

Parámetro Dispositivo Significado y predeterminado
namespace Ambos Namespace obligatorio, p. ej. USBL
transceiver_device, transceiver_ID Ambos Nombre e ID obligatorios para las rutas
transponder_device, transponder_ID Ambos Nombre e ID obligatorios; el transceptor admite IDs separados por comas
transponder_attached_object Transceptor Modelos obligatorios separados por comas, en el mismo orden que los IDs
transceiver_model Transpondedor Modelo obligatorio del transceptor para consultar su posición
sound_speed Ambos Velocidad de referencia a 10 °C y z = 0, m/s; 1540, finita y positiva
enable_ping_scheduler Transceptor Booleano obligatorio; false usa pings manuales
ping_frequency Transceptor Frecuencia en tiempo simulado, Hz; 1, ejemplo 0.5; finita y positiva
interrogation_mode Transceptor common o individual; predeterminado common
mu, sigma Transpondedor Media y desviación estándar del ruido de posición, m; 0 y 1, ejemplo 0 y 0; finitas y sigma ≥ 0

Usa modelos existentes, IDs únicos y listas de IDs/modelos de igual longitud. Los IDs son enteros decimales de 0 a 2147483647, sin signo ni ceros iniciales. Cada plugin necesita un modelo con un enlace. La definición completa incluye geometría y posiciones.

Una configuración inválida deja el plugin inactivo. Se ignoran destinos de canal o comando desconocidos; si el canal es desconocido, se conserva la selección actual. El primer transpondedor de la lista es el canal inicial. Los pings programados se detienen con la simulación y se emiten como máximo una vez por actualización.

Tiempo de propagación

Cada consulta tiene dos trayectos: llegada de la petición al transpondedor y retorno de la posición al transceptor. Cada retardo es distancia dividida por la velocidad del sonido del dispositivo correspondiente.

La velocidad efectiva es sound_speed + 0.017 × depth + 4 × (temperature − 10). Usa m/s, profundidad en m bajo z = 0 y temperatura en °C. Sobre la superficie, la profundidad es cero. La temperatura predeterminada es 10 °C.

Publica std_msgs/msg/Float64 en /USBL/transceiver_manufacturer_168/temperature o /USBL/transponder_manufacturer_1/temperature. El cambio afecta a trayectos posteriores. Se ignoran temperaturas no finitas o cambios que produzcan una velocidad no positiva o no finita.

La aproximación sigue el resumen de velocidad del sonido de DOSITS. Usa distancias rectas, sin refracción, salinidad, multitrayecto ni interferencias. El retorno usa la posición recibida, incluido su ruido configurado.

Consultar todos los transpondedores

ros2 topic pub --once /USBL/transceiver_manufacturer_168/interrogation_mode \
  std_msgs/msg/String "data: 'common'"
ros2 topic pub --once /USBL/common_interrogation_ping \
  std_msgs/msg/String "data: 'ping'"

El modo common emite una difusión por ping programado y puede devolver varios IDs en el mismo topic. Conserva el ID de cada respuesta. El transceptor retiene el modo para los transpondedores que se incorporen después.

Seleccionar un transpondedor

ros2 topic pub --once /USBL/transceiver_manufacturer_168/channel_switch \
  std_msgs/msg/String "data: '1'"
ros2 topic pub --once /USBL/transponder_manufacturer_1/individual_interrogation_ping \
  std_msgs/msg/String "data: 'ping'"

Cambiar de canal selecciona el modo individual; cada ping programado se dirige a ese ID. Vuelve a common para consultar todos los dispositivos.

Dispositivos y modos de consulta

Disposición del transceptor y los transpondedores USBL
Disposición del transceptor y los transpondedores USBL
Flujo de mensajes de interrogación común e individual
Flujo de mensajes de interrogación común e individual
Mediciones de posición del transpondedor
Mediciones de posición del transpondedor

Imágenes: wiki Notion de POSIM; atribución DAVE en Citas y licencias. Usa los comandos y topics de esta página.