Adquiriendo señal…
Adquiriendo señal…
Lección 2 de 12· Control y estimación
0 de 12 lecciones · 0 %
La lección 1 dibujó el grafo de la Estación como cajas unidas por flechas. Esta lección pregunta qué promete cada flecha. En Sistemas distribuidos espaciales (sistemas-distribuidos-espaciales) viste las semánticas de entrega de un bus de eventos —como mucho una vez, al menos una vez, reproducción del historial para el consumidor que se une tarde—. ROS 2 expone exactamente esas decisiones, con otro nombre: calidad de servicio (QoS). Y añade dos patrones de comunicación más allá del tópico. La pieza de la Estación que lo concentra todo es pequeña: src/atp_ros/atp_ros/qos.py, el paquete src/atp_interfaces y la acción de Monte Carlo de campaign_server.py, la misma campaña que en Sistemas APT (sistemas-apt) se hacía en un bucle de Python y aquí se pide por la red.
| Patrón | Forma | Cuándo | En la Estación |
|---|---|---|---|
| Tópico | flujo continuo, muchos a muchos, sin respuesta | datos periódicos | /joint_states, /atp/torque, /atp/link a 20 Hz |
| Servicio | petición y respuesta, uno a uno | consulta corta y puntual | /atp/predict_passes (std_srvs/Trigger) en pass_predictor.py |
| Acción | meta, feedback periódico, resultado; cancelable | tarea larga con progreso | /atp/run_campaign (RunCampaign) en campaign_server.py |
La regla práctica: si el consumidor necesita cada valor de una serie, es un tópico; si necesita una respuesta, un servicio; si la respuesta tarda lo bastante como para querer ver el progreso o cancelarla, una acción. Una campaña Monte Carlo de 300 pases simulando el lazo tarda segundos o minutos: por eso es una acción, y su feedback lleva el percentil 95 parcial.
reliable retransmite lo que se pierde (con NACK de RTPS) hasta que llega o hasta que la cola se desborda; best_effort envía y olvida. Para un sensor rápido donde solo importa el último valor, best_effort evita que un paquete viejo retrase a los nuevos.volatile entrega solo lo publicado después de que el suscriptor se emparejó; transient_local guarda en el publicador las últimas muestras y se las entrega al suscriptor que llega tarde.keep_last con profundidad guarda las últimas muestras (en la cola del publicador y en la del suscriptor); keep_all guarda todas hasta el límite de recursos.El número que se pasa a create_publisher(Tipo, 'topico', 10) es la abreviatura de keep_last con , reliable y volatile, que son los valores por defecto de rclpy.
DDS empareja un publicador y un suscriptor solo si la QoS ofrecida satisface la solicitada. Ordenemos cada política por la fuerza de su promesa: y . La regla es
Por qué tiene que ser así. Supón un publicador best_effort y un suscriptor reliable. El suscriptor exige que toda muestra perdida se retransmita; para retransmitir hace falta que el publicador guarde lo enviado y responda a los NACK, y un escritor best_effort no hace ninguna de las dos cosas. No hay forma de cumplir la promesa, así que DDS se niega a emparejar y avisa con un evento de QoS incompatible. En sentido contrario, un publicador reliable con un suscriptor best_effort sí funciona: el escritor está dispuesto a retransmitir y el lector simplemente no lo pide. Lo mismo con la durabilidad: un suscriptor transient_local pide el pasado; un publicador volatile no lo guardó. De ahí la tabla, que el playground recalcula:
| Publicador ofrece | Suscriptor pide | ¿Empareja? |
|---|---|---|
best_effort | best_effort | sí |
best_effort | reliable | no |
reliable | best_effort | sí |
reliable | reliable | sí |
Lo traicionero es que una incompatibilidad no da error: el grafo muestra las dos puntas en el mismo tópico y no circula nada. ros2 topic info -v imprime la QoS de cada extremo y es la primera herramienta cuando «el tópico existe pero no llega nada».
MEDICION y el suscriptor que llega tardeEste es todo el archivo qos.py de la Estación:
# src/atp_ros/atp_ros/qos.py
from rclpy.qos import DurabilityPolicy, HistoryPolicy, QoSProfile
# Topicos de MEDICION que nacen y mueren dentro de la Estacion
# (/atp/pointing_error, /atp/link): con durabilidad transient_local, un
# suscriptor que termina de descubrir al publicador tarde recibe el historial
# en vez de perder el principio del pase. 2000 muestras = 100 s a 20 Hz.
MEDICION = QoSProfile(depth=2000, history=HistoryPolicy.KEEP_LAST,
durability=DurabilityPolicy.TRANSIENT_LOCAL)
error_monitor publica /atp/pointing_error con MEDICION; link_budget se suscribe a ese tópico y publica /atp/link con el mismo perfil; recorder se suscribe a ambos con él. La fiabilidad no aparece porque el valor por defecto ya es reliable.
El problema que resuelve: el descubrimiento de DDS no es instantáneo. Con la máquina cargada, un suscriptor puede tardar segundos en emparejarse con su publicador, y durante ese tiempo un tópico volatile simplemente no le entrega nada. Si el que llega tarde es el grabador, la corrida guarda un pase sin su principio.
Un publicador emite a tasa desde ; el suscriptor termina de emparejarse en . En ese intervalo se publicaron muestras. Con transient_local y keep_last de profundidad , al emparejarse el publicador le entrega las últimas. Se pierden
y no se pierde nada si y solo si . Con los valores del laboratorio:
El perfil MEDICION usa , que cubre un retraso de s: holgura de sobra para el arranque más lento. El precio es memoria en el publicador, : con los 44 bytes de un PointingError serializado, kB, despreciable. Con profundidad 50 en cambio el suscriptor tardío recuperaría 50 de las 60 muestras y perdería las 10 primeras.
Los nodos pasivos de la Estación (monitor, enlace, grabador) usan además colas de suscripción de 200 en sus otros tópicos, para no perder nada aunque el ejecutor se retrase: es la regla 3 del contrato de lockstep (docs/CONTRATO.md §8), que veremos en la lección 3.
Cuando ningún mensaje estándar encaja, se define uno. atp_interfaces es un paquete ament_cmake que solo contiene definiciones:
# src/atp_interfaces/msg/PointingError.msg
# Error de apuntamiento de UN instante (sello = instante del lockstep).
std_msgs/Header header
float64 e_az_deg
float64 e_el_deg
float64 e_pt_deg # separacion angular real: hypot(e_az cos el, e_el)
# src/atp_interfaces/CMakeLists.txt
find_package(rosidl_default_generators REQUIRED)
rosidl_generate_interfaces(${PROJECT_NAME}
"msg/SatState.msg"
"msg/LinkStatus.msg"
"msg/PointingError.msg"
"msg/ReferenceHorizon.msg"
"action/RunCampaign.action"
DEPENDENCIES std_msgs action_msgs)
rosidl genera a partir de cada archivo las clases de Python y de C++ y el código de serialización CDR. Por eso las interfaces viven en un paquete ament_cmake aunque todos los nodos que las usan sean de Python. Las cuatro de la Estación: SatState (acimut desenroscado, elevación, rango, tasa de rango, tiempo desde AOS), LinkStatus (Doppler, pérdida por desapuntamiento dB, C/N0, margen), PointingError (arriba) y ReferenceHorizon (la efeméride futura para el MPC de la lección 8).
RunCampaignUn archivo .action tiene tres secciones separadas por ---: meta, resultado y feedback.
# src/atp_interfaces/action/RunCampaign.action (recortado)
string mode # "analitico" o "lazo"
int32 n
int32 seed
float64 kp
---
float64[] rms_deg
float64 p95_deg
bool meets_objective # p95 < objetivo
float64 wall_time_s
---
int32 done
int32 total
float64 p95_running_deg
El servidor publica el progreso mientras simula y termina con succeed():
# src/atp_ros/atp_ros/campaign_server.py (recortado)
self.server = ActionServer(self, RunCampaign, '/atp/run_campaign', self.execute)
def execute(self, handle):
fb = RunCampaign.Feedback()
def progreso(i, total):
fb.done, fb.total = int(i * n / total), n
handle.publish_feedback(fb)
out = model.campana_lazo(progreso=progreso, **kw)
...
fb.done, fb.total, fb.p95_running_deg = n, n, pc['p95']
handle.publish_feedback(fb)
handle.succeed()
Desde la línea de comandos, así la ejercita scripts/validar.sh en el escalón N4:
ros2 action send_goal --feedback /atp/run_campaign atp_interfaces/action/RunCampaign "{mode: lazo, n: 300}"
La referencia de la escalera para esa campaña es p95 de 0.042° con el lazo y (README.md, escalón N4).
El programa aplica la regla de compatibilidad, simula diez segundos de un tópico a 20 Hz con un suscriptor que se empareja a los 3 s y una red que pierde el 5 % de los paquetes, y cuenta lo que llega con cada perfil.
Un publicador ofrece reliable + volatile y un suscriptor pide reliable + transient_local. ¿Qué pasa?
El laboratorio empieza en «Medición (perfil MEDICION)» con tasa 20 Hz, retraso de descubrimiento 3 s, pérdida de red 5 % y profundidad 2000: el veredicto dice «compatible», la lectura de profundidad necesaria marca y en la línea de tiempo verás las primeras 60 muestras entregadas en bloque desde el historial cuando el suscriptor aparece, sin pérdidas. Baja la profundidad a 50: diez muestras del principio quedan marcadas como perdidas. Pulsa el chip de durabilidad del suscriptor a volatile (escenario «Suscriptor tardío sin historial»): las 60 se pierden. Elige «Incompatible»: el veredicto cambia y da el motivo, «el suscriptor pide reliable y el publicador ofrece best_effort», y la línea de tiempo del suscriptor queda vacía. En «Sensor por defecto» sube la pérdida de red a 30 % y mira cómo los huecos aparecen dispersos a lo largo de todo el flujo, no solo al principio.
reliable. Con keep_last, si el suscriptor es más lento que el publicador durante más de muestras, las viejas se sobrescriben aunque la fiabilidad sea reliable: «fiable» no significa «sin pérdidas a cualquier ritmo».rclcpp_components y los nodos con ciclo de vida (lifecycle nodes): existen y los usa ros2_control (lección 7), pero aquí no se tratan en detalle.Ya sabemos qué promete cada flecha. Falta lo más delicado: en qué orden y con qué sello de tiempo llegan los mensajes de un lazo cerrado. Eso decide si dos corridas idénticas dan el mismo número, y es la lección 3.
Cierre de la lección
Sigue el recorrido de la lección paso a paso.
Con una cuenta desbloqueas el cuestionario, el foro de dudas y el tutor con IA de esta lección, además del registro de progreso y el certificado verificable al terminar «ROS 2 aplicado: la Estación ATP de punta a punta».