Adquiriendo señal…
Adquiriendo señal…
Lección 4 de 12· Control y estimación
0 de 12 lecciones · 0 %
Todo el trabajo de una estación terrena se reduce a que dos direcciones coincidan: hacia dónde mira el plato y dónde está el satélite. En Mecánica orbital (mecanica-orbital) aprendiste a sacar la posición del satélite de un TLE con SGP4; en Sistemas APT (sistemas-apt) la convertiste en acimut y elevación vistos desde la estación. Esta lección hace la otra mitad en ROS 2: describe la montura de la Estación como un árbol de marcos con URDF, deja que TF2 componga las transformaciones y define con precisión qué número es «el error de apuntamiento». Las piezas son src/atp_description (el URDF), atp_twin.launch.py (el gemelo), orbit.py y reference_generator.py (la referencia) y msg/SatState.msg.
docs/SEGUIDOR.md §1 resume el seguidor de punta a punta: TLE → SGP4 → az/el → referencia → control → montura → cielo. La primera mitad vive en orbit.py, cuyo encabezado enumera cada marco y lo que en él se desprecia:
| Paso | Qué hace | Lo que se desprecia (orbit.py) |
|---|---|---|
| TLE → TEME | SGP4: posición y velocidad en km, km/s | error propio de SGP4/TLE, unos 1 km en la época y 1–3 km/día después |
| TEME → ECEF | rotación | movimiento del polo (unos 10 m) y UT1−UTC (hasta 0.44 km en LEO, corregible con dut1_s) |
| ECEF → ENU | restar la estación WGS84 y proyectar en Este, Norte, Arriba | refracción (a 5° subiría la elevación aparente unos 0.17°) |
| ENU → az/el | , | — |
# src/atp_ros/atp_ros/orbit.py (recortado)
def matriz_enu(lat_deg, lon_deg):
"""Filas = ejes E, N, U expresados en ECEF para la latitud GEODESICA
(no la geocentrica: confundirlas da ~0.2 deg de error)."""
la, lo = math.radians(lat_deg), math.radians(lon_deg)
return np.array([
[-math.sin(lo), math.cos(lo), 0.0],
[-math.sin(la) * math.cos(lo), -math.sin(la) * math.sin(lo), math.cos(la)],
[math.cos(la) * math.cos(lo), math.cos(la) * math.sin(lo), math.sin(la)]])
def enu_a_azel(e, n, u):
"""Ejemplo resuelto del curso: (400, 300, 500) -> az 53.13, el 45.0,
d 707.1. Cuidado: atan2(E, N), no atan2(N, E)."""
rho = np.sqrt(e ** 2 + n ** 2 + u ** 2)
az = np.degrees(np.arctan2(e, n)) % 360.0
el = np.degrees(np.arcsin(np.clip(u / np.where(rho > 0, rho, 1.0), -1, 1)))
return az, el, rho
El escalón S4 de la escalera de validación (README.md) corre esta cadena con un pase real de la ISS sobre la Ciudad de México dentro del lazo: 0.001° rms de apuntamiento, y SGP4 contrastado con los vectores de prueba de Vallado con una diferencia de km. El generador de referencia publica el resultado a 20 Hz en /atp/reference (las articulaciones, en rad) y en /atp/sat_state:
# src/atp_interfaces/msg/SatState.msg
std_msgs/Header header
float64 az_deg # acimut continuo (desenroscado)
float64 el_deg
float64 range_km # rango oblicuo
float64 range_rate_km_s # + = se aleja
float64 t_since_aos_s
float64 pass_duration_s
Acimut continuo. Un pase que cruza el norte va de 359° a 1°. Si la referencia salta de 359 a 1, el controlador ve un error de 358° y hace girar la montura casi una vuelta en sentido contrario. orbit.muestrear_pase lo evita con np.unwrap: cada salto mayor de 180° se corrige sumando o restando 360°, y la serie 358, 359, 1, 2 se convierte en 358, 359, 361, 362. Por eso la junta de acimut del URDF es continuous, sin límites.
URDF (Unified Robot Description Format) describe un robot como eslabones (link, cuerpos rígidos con inercia y geometría) unidos por juntas (joint, con un padre, un hijo, un origen y un eje). Los tipos que usa la Estación: fixed (sin grado de libertad), continuous (gira sin límite) y revolute (gira entre lower y upper). xacro es un preprocesador que añade argumentos, propiedades y macros.
<!-- src/atp_description/urdf/antena.urdf.xacro (recortado) -->
<joint name="az" type="continuous">
<parent link="base_link"/><child link="az_link"/>
<origin xyz="0 0 1.0"/><axis xyz="0 0 1"/>
<dynamics damping="$(arg b)" friction="0.0"/>
<limit effort="$(arg u_max)" velocity="3.0"/>
</joint>
<!-- el plato apunta a +X cuando el = 0; el eje es -Y -->
<joint name="el" type="revolute">
<parent link="az_link"/><child link="el_link"/>
<origin xyz="0 0 0.9"/><axis xyz="0 -1 0"/>
<limit lower="0" upper="3.14159" effort="$(arg u_max)" velocity="3.0"/>
</joint>
<link name="boresight"/>
<joint name="boresight_joint" type="fixed">
<parent link="el_link"/><child link="boresight"/><origin xyz="1.55 0 0"/>
</joint>
El árbol completo es world → base_link → az_link → el_link → boresight. Los números del URDF son los de la planta de la lección 5: damping es N·m·s/rad, el tope de par u_max 8 N·m, y la inercia esférica del plato hace kg·m² en cualquier elevación. El límite superior de elevación, , permite el giro sobre el cénit que la lección 8 usa contra el keyhole.
Cada junta define una transformación homogénea de 4 × 4 entre el marco del padre y el del hijo: una rotación y una traslación ,
Para la Estación, , y . Con y el origen del marco boresight queda en m: 1.9 m de altura del eje de elevación más m.
En ROS no se multiplican matrices a mano. robot_state_publisher lee el URDF (parámetro robot_description), se suscribe a /joint_states y publica en /tf la transformación de cada junta móvil y en /tf_static las fijas. Así lo monta el gemelo:
# src/atp_ros/launch/atp_twin.launch.py (recortado)
lazo = IncludeLaunchDescription(
PythonLaunchDescriptionSource(os.path.join(share, 'launch', 'atp_loop.launch.py')),
launch_arguments={'exit_on_done': 'false'}.items())
rsp = Node(package='robot_state_publisher', executable='robot_state_publisher',
parameters=[{'robot_description': urdf, 'use_sim_time': True}])
Es el escalón N3 («gemelo URDF + TF2: boresight en TF»). Cualquier nodo puede pedir luego la transformación compuesta con un tf2_ros.Buffer y lookup_transform('world', 'boresight', tiempo); desde la terminal, ros2 run tf2_ros tf2_echo world boresight. El repositorio no consulta TF desde ningún nodo: el gemelo es para ver la montura en RViz, y el error se calcula con la geometría de la sección siguiente.
Un aviso honesto que el propio lanzamiento deja escrito: la junta az del URDF gira antihoraria alrededor de , mientras que el acimut astronómico es horario desde el norte. La Estación publica el ángulo tal cual y lo documenta en vez de ocultarlo. Si el marco world fuera ENU (X al este, Y al norte), la junta tendría que recibir para que el gemelo apunte al mismo punto del cielo.
El vector. En ENU, una dirección con acimut (desde el norte hacia el este) y elevación tiene componente vertical y proyección horizontal de longitud ; esa proyección forma el ángulo con el eje norte, así que reparte al este y al norte:
Es unitario porque .
El error exacto. Con de la montura en y del satélite en , el error de apuntamiento es el ángulo entre ambos, . Desarrollando el producto escalar:
La aproximación. Usando en y reconociendo :
Esta es la fórmula del haversine, exacta. Para ángulos pequeños, y , y queda
que es la que escribe PointingError.msg (e_pt_deg: «hypot(e_az cos el, e_el)») y la que calcula error_monitor.py con la elevación de la referencia. El factor es la clave: un grado de acimut cerca del cénit es casi nada en el cielo, y por eso el keyhole (lección 8) pide velocidades de acimut enormes sin que el error angular se dispare.
Montura en , ; satélite en , . Los vectores son y , con . Entonces:
error_monitor: .Las tres coinciden en la centésima: las aproximaciones se apartan del valor exacto , una por arriba y otra por abajo, porque queda entre y . Un detalle numérico: cerca de 1 pierde precisión, porque su resolución en coma flotante doble es rad grados. Para errores de milésimas de grado como los de S4 sobra; para algo más fino conviene , que es lo que hace el playground.
El programa compone el árbol TF de la Estación con matrices de 4 × 4, calcula los dos vectores del ejemplo, el error exacto por dos caminos y las dos aproximaciones, reproduce el ejemplo de enu_a_azel y desenrosca un acimut que cruza el norte.
La montura apunta a az 30°, el 45° y el satélite está en az 31°, el 45.5°. ¿Cuál es aproximadamente el error de apuntamiento?
El laboratorio arranca en el escenario «Ejemplo de la lección (az 30, el 45; sat 31 / 45.5)»: con az de la junta 30, el 45 y el satélite en 31 / 45.5, las lecturas deben dar el boresight ENU (0.354, 0.612, 0.707), el error exacto de unos 0.86° y el aproximado de unos 0.87°. En la escena derecha, el árbol TF lista cada marco con su traslación y su rotación y el producto acumulado world → boresight. Lleva el deslizador el hacia 85° sin tocar el acimut del satélite: el término se encoge y el error cae aunque siga valiendo 1°. Elige «Satélite rasante (el 5)» y verás lo contrario: casi todo el grado de acimut se convierte en error. Por último, en los controles avanzados sube la inclinación de la base a 0.5° (escenario «Base inclinada 0.5°»): las juntas leen lo mismo, pero el boresight real se desvía y aparece un error que ninguna lectura de encoder delata; es el problema de calibración de la lección 10.
damping del URDF solo los usa Gazebo; la planta que mueve la montura en atp_loop es planta.py (lección 5), no el URDF.orbit.py con numpy y sgp4, que el playground no tiene.Con esta lección termina el bloque de fundamentos de ROS 2: tenemos el grafo, sus garantías, el tiempo y la geometría. La lección 5 entra en la física de la montura y en el lazo PID que la mueve.
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».